libalsa-intf/alsa_pcm.c

/*
** Copyright 2010, The Android Open-Source Project
** Copyright (c) 2011-2012, Code Aurora Forum. All rights reserved.
**
** Licensed under the Apache License, Version 2.0 (the "License");
** you may not use this file except in compliance with the License.
** You may obtain a copy of the License at
**
**     http://www.apache.org/licenses/LICENSE-2.0
**
** Unless required by applicable law or agreed to in writing, software
** distributed under the License is distributed on an "AS IS" BASIS,
** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
** See the License for the specific language governing permissions and
** limitations under the License.
*/

#define LOG_TAG "alsa_pcm"
#define LOG_NDEBUG 1
#ifdef ANDROID
/* definitions for Android logging */
#include <utils/Log.h>
#include <cutils/properties.h>
#else /* ANDROID */
#define strlcat g_strlcat
#define strlcpy g_strlcpy
#define ALOGI(...)      fprintf(stdout, __VA_ARGS__)
#define ALOGE(...)      fprintf(stderr, __VA_ARGS__)
#define ALOGV(...)      fprintf(stderr, __VA_ARGS__)
#endif /* ANDROID */

#include <stdio.h>
#include <stdlib.h>
#include <fcntl.h>
#include <stdarg.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>
#include <stdint.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
#include <sys/time.h>
#include <sys/poll.h>
#include <linux/ioctl.h>
#include <linux/types.h>
#ifdef QCOM_COMPRESSED_AUDIO_ENABLED
#include <sound/compress_params.h>
#endif
#include "alsa_audio.h"

#define __force
#define __bitwise
#define __user

#define DEBUG 1

enum format_alias {
      S8 = 0,
      U8,
      S16_LE,
      S16_BE,
      U16_LE,
      U16_BE,
      S24_LE,
      S24_BE,
      U24_LE,
      U24_BE,
      S32_LE,
      S32_BE,
      U32_LE,
      U32_BE,
      FLOAT_LE,
      FLOAT_BE,
      FLOAT64_LE,
      FLOAT64_BE,
      IEC958_SUBFRAME_LE,
      IEC958_SUBFRAME_BE,
      MU_LAW,
      A_LAW,
      IMA_ADPCM,
      MPEG,
      GSM,
      SPECIAL = 31,
      S24_3LE,
      S24_3BE,
      U24_3LE,
      U24_3BE,
      S20_3LE,
      S20_3BE,
      U20_3LE,
      U20_3BE,
      S18_3LE,
      S18_3BE,
      U18_3LE,
      U18_3BE,
      FORMAT_LAST,
};
const char *formats_list[][2] = {
        {"S8", "Signed 8 bit"},
        {"U8", "Unsigned 8 bit"},
        {"S16_LE", "Signed 16 bit Little Endian"},
        {"S16_BE", "Signed 16 bit Big Endian"},
        {"U16_LE", "Unsigned 16 bit Little Endian"},
        {"U16_BE", "Unsigned 16 bit Big Endian"},
        {"S24_LE", "Signed 24 bit Little Endian"},
        {"S24_BE", "Signed 24 bit Big Endian"},
        {"U24_LE", "Unsigned 24 bit Little Endian"},
        {"U24_BE", "Unsigned 24 bit Big Endian"},
        {"S32_LE", "Signed 32 bit Little Endian"},
        {"S32_BE", "Signed 32 bit Big Endian"},
        {"U32_LE", "Unsigned 32 bit Little Endian"},
        {"U32_BE", "Unsigned 32 bit Big Endian"},
        {"FLOAT_LE", "Float 32 bit Little Endian"},
        {"FLOAT_BE", "Float 32 bit Big Endian"},
        {"FLOAT64_LE", "Float 64 bit Little Endian"},
        {"FLOAT64_BE", "Float 64 bit Big Endian"},
        {"IEC958_SUBFRAME_LE", "IEC-958 Little Endian"},
        {"IEC958_SUBFRAME_BE", "IEC-958 Big Endian"},
        {"MU_LAW", "Mu-Law"},
        {"A_LAW", "A-Law"},
        {"IMA_ADPCM", "Ima-ADPCM"},
        {"MPEG", "MPEG"},
        {"GSM", "GSM"},
        [31] = {"SPECIAL", "Special"},
        {"S24_3LE", "Signed 24 bit Little Endian in 3bytes"},
        {"S24_3BE", "Signed 24 bit Big Endian in 3bytes"},
        {"U24_3LE", "Unsigned 24 bit Little Endian in 3bytes"},
        {"U24_3BE", "Unsigned 24 bit Big Endian in 3bytes"},
        {"S20_3LE", "Signed 20 bit Little Endian in 3bytes"},
        {"S20_3BE", "Signed 20 bit Big Endian in 3bytes"},
        {"U20_3LE", "Unsigned 20 bit Little Endian in 3bytes"},
        {"U20_3BE", "Unsigned 20 bit Big Endian in 3bytes"},
        {"S18_3LE", "Signed 18 bit Little Endian in 3bytes"},
        {"S18_3BE", "Signed 18 bit Big Endian in 3bytes"},
        {"U18_3LE", "Unsigned 18 bit Little Endian in 3bytes"},
        {"U18_3BE", "Unsigned 18 bit Big Endian in 3bytes"},
};
enum decoder_alias {
    FORMAT_MP3              = SND_AUDIOCODEC_MP3,
    FORMAT_AAC              = SND_AUDIOCODEC_AAC,
    FORMAT_AC3_PASS_THROUGH = SND_AUDIOCODEC_AC3_PASS_THROUGH,
    FORMAT_WMA              = SND_AUDIOCODEC_WMA,
    FORMAT_WMA_PRO          = SND_AUDIOCODEC_WMA_PRO,
    FORMAT_DTS              = SND_AUDIOCODEC_DTS,
    FORMAT_DTS_LBR          = SND_AUDIOCODEC_DTS_LBR,
    FORMAT_DTS_PASS_THROUGH = SND_AUDIOCODEC_DTS_PASS_THROUGH,
    FORMAT_AMRWB            = SND_AUDIOCODEC_AMRWB,
    FORMAT_AMRWB_PLUS       = SND_AUDIOCODEC_AMRWBPLUS
};

int get_compressed_format(const char *format)
{
        const char *ch = format;
        if (strcmp(ch, "MP3") == 0) {
                printf("MP3 is selected\n");
                return FORMAT_MP3;
        } else if (strcmp(ch, "AC3_PASS_THROUGH") == 0) {
                printf("AC3 PASS THROUGH is selected\n");
                return FORMAT_AC3_PASS_THROUGH;
        } else if (strcmp(ch, "AAC") == 0) {
                printf("AAC is selected\n");
                return FORMAT_AAC;
        } else if (strcmp(ch, "AC3_PASS_THROUGH") == 0) {
                printf("AC3_PASS_THROUGH is selected\n");
                return FORMAT_AC3_PASS_THROUGH;
        } else if (strcmp(ch, "WMA") == 0) {
                printf("WMA is selected\n");
                return FORMAT_WMA;
        }else if (strcmp(ch, "WMA_PRO") == 0) {
                printf("WMA_PRO is selected\n");
                return FORMAT_WMA_PRO;
        }else if (strcmp(ch, "DTS") == 0) {
                printf("DTS is selected\n");
                return FORMAT_DTS;
        } else if (strcmp(ch, "DTS_LBR") == 0) {
                printf("DTS_LBR is selected\n");
                return FORMAT_DTS_LBR;
        } else if (strcmp(ch, "AMR_WB") == 0) {
                printf("AMR_WB is selected\n");
                return FORMAT_AMRWB;
        }else if (strcmp(ch, "AMR_WB_PLUS") == 0) {
                printf("FORMAT_AMRWB_PLUS is selected\n");
                return FORMAT_AMRWB_PLUS;
        } else {
                printf("invalid format\n");
                return -1;
        }
        return 0;
}

int get_format(const char* name)
{
        int format;
        for (format = 0; format < FORMAT_LAST; format++) {
                if (formats_list[format][0] &&
                    strcasecmp(name, formats_list[format][0]) == 0) {
                        ALOGV("format_names %s", name);
                        return  format;
                }
        }
        return -EINVAL;
}

const char *get_format_name(int format)
{
        if ((format < FORMAT_LAST) &&
             formats_list[format][0])
            return formats_list[format][0];
        return NULL;
}

const char *get_format_desc(int format)
{
        if ((format < FORMAT_LAST) &&
             formats_list[format][1])
            return formats_list[format][1];
        return NULL;
}

/* alsa parameter manipulation cruft */

#define PARAM_MAX SNDRV_PCM_HW_PARAM_LAST_INTERVAL
static int oops(struct pcm *pcm, int e, const char *fmt, ...);

static inline int param_is_mask(int p)
{
    return (p >= SNDRV_PCM_HW_PARAM_FIRST_MASK) &&
        (p <= SNDRV_PCM_HW_PARAM_LAST_MASK);
}

static inline int param_is_interval(int p)
{
    return (p >= SNDRV_PCM_HW_PARAM_FIRST_INTERVAL) &&
        (p <= SNDRV_PCM_HW_PARAM_LAST_INTERVAL);
}

static inline struct snd_interval *param_to_interval(struct snd_pcm_hw_params *p, int n)
{
    return &(p->intervals[n - SNDRV_PCM_HW_PARAM_FIRST_INTERVAL]);
}

static inline struct snd_mask *param_to_mask(struct snd_pcm_hw_params *p, int n)
{
    return &(p->masks[n - SNDRV_PCM_HW_PARAM_FIRST_MASK]);
}

void param_set_mask(struct snd_pcm_hw_params *p, int n, unsigned bit)
{
    if (bit >= SNDRV_MASK_MAX)
        return;
    if (param_is_mask(n)) {
        struct snd_mask *m = param_to_mask(p, n);
        m->bits[0] = 0;
        m->bits[1] = 0;
        m->bits[bit >> 5] |= (1 << (bit & 31));
    }
}

void param_set_min(struct snd_pcm_hw_params *p, int n, unsigned val)
{
    if (param_is_interval(n)) {
        struct snd_interval *i = param_to_interval(p, n);
        i->min = val;
    }
}

void param_set_max(struct snd_pcm_hw_params *p, int n, unsigned val)
{
    if (param_is_interval(n)) {
        struct snd_interval *i = param_to_interval(p, n);
        i->max = val;
    }
}

void param_set_int(struct snd_pcm_hw_params *p, int n, unsigned val)
{
    if (param_is_interval(n)) {
        struct snd_interval *i = param_to_interval(p, n);
        i->min = val;
        i->max = val;
        i->integer = 1;
    }
}

void param_init(struct snd_pcm_hw_params *p)
{
    int n;
    memset(p, 0, sizeof(*p));
    for (n = SNDRV_PCM_HW_PARAM_FIRST_MASK;
         n <= SNDRV_PCM_HW_PARAM_LAST_MASK; n++) {
            struct snd_mask *m = param_to_mask(p, n);
            m->bits[0] = ~0;
            m->bits[1] = ~0;
    }
    for (n = SNDRV_PCM_HW_PARAM_FIRST_INTERVAL;
         n <= SNDRV_PCM_HW_PARAM_LAST_INTERVAL; n++) {
            struct snd_interval *i = param_to_interval(p, n);
            i->min = 0;
            i->max = ~0;
    }
}

/* debugging gunk */

#if DEBUG
static const char *param_name[PARAM_MAX+1] = {
    [SNDRV_PCM_HW_PARAM_ACCESS] = "access",
    [SNDRV_PCM_HW_PARAM_FORMAT] = "format",
    [SNDRV_PCM_HW_PARAM_SUBFORMAT] = "subformat",

    [SNDRV_PCM_HW_PARAM_SAMPLE_BITS] = "sample_bits",
    [SNDRV_PCM_HW_PARAM_FRAME_BITS] = "frame_bits",
    [SNDRV_PCM_HW_PARAM_CHANNELS] = "channels",
    [SNDRV_PCM_HW_PARAM_RATE] = "rate",
    [SNDRV_PCM_HW_PARAM_PERIOD_TIME] = "period_time",
    [SNDRV_PCM_HW_PARAM_PERIOD_SIZE] = "period_size",
    [SNDRV_PCM_HW_PARAM_PERIOD_BYTES] = "period_bytes",
    [SNDRV_PCM_HW_PARAM_PERIODS] = "periods",
    [SNDRV_PCM_HW_PARAM_BUFFER_TIME] = "buffer_time",
    [SNDRV_PCM_HW_PARAM_BUFFER_SIZE] = "buffer_size",
    [SNDRV_PCM_HW_PARAM_BUFFER_BYTES] = "buffer_bytes",
    [SNDRV_PCM_HW_PARAM_TICK_TIME] = "tick_time",
};

void param_dump(struct snd_pcm_hw_params *p)
{
    int n;

    for (n = SNDRV_PCM_HW_PARAM_FIRST_MASK;
         n <= SNDRV_PCM_HW_PARAM_LAST_MASK; n++) {
            struct snd_mask *m = param_to_mask(p, n);
            ALOGV("%s = %08x%08x\n", param_name[n],
                   m->bits[1], m->bits[0]);
    }
    for (n = SNDRV_PCM_HW_PARAM_FIRST_INTERVAL;
         n <= SNDRV_PCM_HW_PARAM_LAST_INTERVAL; n++) {
            struct snd_interval *i = param_to_interval(p, n);
            ALOGV("%s = (%d,%d) omin=%d omax=%d int=%d empty=%d\n",
                   param_name[n], i->min, i->max, i->openmin,
                   i->openmax, i->integer, i->empty);
    }
    ALOGV("info = %08x\n", p->info);
    ALOGV("msbits = %d\n", p->msbits);
    ALOGV("rate = %d/%d\n", p->rate_num, p->rate_den);
    ALOGV("fifo = %d\n", (int) p->fifo_size);
}

static void info_dump(struct snd_pcm_info *info)
{
    ALOGV("device = %d\n", info->device);
    ALOGV("subdevice = %d\n", info->subdevice);
    ALOGV("stream = %d\n", info->stream);
    ALOGV("card = %d\n", info->card);
    ALOGV("id = '%s'\n", info->id);
    ALOGV("name = '%s'\n", info->name);
    ALOGV("subname = '%s'\n", info->subname);
    ALOGV("dev_class = %d\n", info->dev_class);
    ALOGV("dev_subclass = %d\n", info->dev_subclass);
    ALOGV("subdevices_count = %d\n", info->subdevices_count);
    ALOGV("subdevices_avail = %d\n", info->subdevices_avail);
}
#else
void param_dump(struct snd_pcm_hw_params *p) {}
static void info_dump(struct snd_pcm_info *info) {}
#endif

int param_set_hw_refine(struct pcm *pcm, struct snd_pcm_hw_params *params)
{
    if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_HW_REFINE, params)) {
        ALOGE("SNDRV_PCM_IOCTL_HW_REFINE failed");
        return -EPERM;
    }
    return 0;
}

int param_set_hw_params(struct pcm *pcm, struct snd_pcm_hw_params *params)
{
    if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_HW_PARAMS, params)) {
        return -EPERM;
    }
    pcm->hw_p = params;
    return 0;
}

int param_set_sw_params(struct pcm *pcm, struct snd_pcm_sw_params *sparams)
{
    if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_SW_PARAMS, sparams)) {
        return -EPERM;
    }
    pcm->sw_p = sparams;
    return 0;
}

int pcm_buffer_size(struct snd_pcm_hw_params *params)
{
    struct snd_interval *i = param_to_interval(params, SNDRV_PCM_HW_PARAM_BUFFER_BYTES);
            ALOGV("%s = (%d,%d) omin=%d omax=%d int=%d empty=%d\n",
                   param_name[SNDRV_PCM_HW_PARAM_BUFFER_BYTES],
                   i->min, i->max, i->openmin,
                   i->openmax, i->integer, i->empty);
    return i->min;
}

int pcm_period_size(struct snd_pcm_hw_params *params)
{
    struct snd_interval *i = param_to_interval(params, SNDRV_PCM_HW_PARAM_PERIOD_BYTES);
            ALOGV("%s = (%d,%d) omin=%d omax=%d int=%d empty=%d\n",
                   param_name[SNDRV_PCM_HW_PARAM_PERIOD_BYTES],
                   i->min, i->max, i->openmin,
                   i->openmax, i->integer, i->empty);
    return i->min;
}

const char* pcm_error(struct pcm *pcm)
{
    return pcm->error;
}

static int oops(struct pcm *pcm, int e, const char *fmt, ...)
{
    va_list ap;
    int sz;

    va_start(ap, fmt);
    vsnprintf(pcm->error, PCM_ERROR_MAX, fmt, ap);
    va_end(ap);
    sz = strnlen(pcm->error, PCM_ERROR_MAX);

    if (errno)
        snprintf(pcm->error + sz, PCM_ERROR_MAX - sz,
                 ": %s", strerror(e));
    return -1;
}

long pcm_avail(struct pcm *pcm)
{
     struct snd_pcm_sync_ptr *sync_ptr = pcm->sync_ptr;
     if (pcm->flags & DEBUG_ON) {
        ALOGV("hw_ptr = %d buf_size = %d appl_ptr = %d\n",
                sync_ptr->s.status.hw_ptr,
                pcm->buffer_size,
                sync_ptr->c.control.appl_ptr);
     }
     if (pcm->flags & PCM_IN) {
          long avail = sync_ptr->s.status.hw_ptr - sync_ptr->c.control.appl_ptr;
        if (avail < 0)
                avail += pcm->sw_p->boundary;
        return avail;
     } else {
         int buffer_size = 0;
         long avail;
         if(pcm->flags & PCM_MONO)
             buffer_size = pcm->buffer_size/2;
         else if(pcm->flags & PCM_QUAD)
             buffer_size = pcm->buffer_size/8;
         else if(pcm->flags & PCM_5POINT1)
             buffer_size = pcm->buffer_size/12;
         else if(pcm->flags & PCM_7POINT1)
             buffer_size = pcm->buffer_size/16;
         else
             buffer_size = pcm->buffer_size/4;

         avail = sync_ptr->s.status.hw_ptr - sync_ptr->c.control.appl_ptr + buffer_size;
         if (avail < 0)
              avail += pcm->sw_p->boundary;
         else if ((unsigned long) avail >= pcm->sw_p->boundary)
              avail -= pcm->sw_p->boundary;
         return avail;
     }
}

int sync_ptr(struct pcm *pcm)
{
    int err;
    err = ioctl(pcm->fd, SNDRV_PCM_IOCTL_SYNC_PTR, pcm->sync_ptr);
    if (err < 0) {
        err = errno;
        ALOGE("SNDRV_PCM_IOCTL_SYNC_PTR failed %d \n", err);
        return err;
    }

    return 0;
}

int mmap_buffer(struct pcm *pcm)
{
    int err, i;
    char *ptr;
    unsigned size;
    struct snd_pcm_channel_info ch;
    int channels;

    if(pcm->flags & PCM_MONO)
        channels = 1;
    else if(pcm->flags & PCM_QUAD)
        channels = 4;
    else if(pcm->flags & PCM_5POINT1)
        channels = 6;
    else if(pcm->flags & PCM_7POINT1)
        channels = 8;
    else
        channels = 2;

    size = pcm->buffer_size;
    if (pcm->flags & DEBUG_ON)
        ALOGV("size = %d\n", size);
    pcm->addr = mmap(NULL, size, PROT_READ|PROT_WRITE, MAP_SHARED,
                           pcm->fd, 0);
    if (pcm->addr)
         return 0;
    else
         return -errno;
}

/*
 * Destination offset would be mod of total data written
 * (application pointer) and the buffer size of the driver.
 * Hence destination address would be base address(pcm->addr) +
 * destination offset.
 */
u_int8_t *dst_address(struct pcm *pcm)
{
    unsigned long pcm_offset = 0;
    struct snd_pcm_sync_ptr *sync_ptr = pcm->sync_ptr;
    unsigned int appl_ptr = 0;
    int channels;
    if(pcm->flags & PCM_MONO)
        channels = 1;
    else if(pcm->flags & PCM_QUAD)
        channels = 4;
    else if(pcm->flags & PCM_5POINT1)
        channels = 6;
    else if(pcm->flags & PCM_7POINT1)
        channels = 8;
    else
        channels = 2;

    appl_ptr = sync_ptr->c.control.appl_ptr*2*channels;
    pcm_offset = (appl_ptr % (unsigned long)pcm->buffer_size);
    return pcm->addr + pcm_offset;

}

int mmap_transfer(struct pcm *pcm, void *data, unsigned offset,
                  long frames)
{
    struct snd_pcm_sync_ptr *sync_ptr = pcm->sync_ptr;
    unsigned size;
    u_int8_t *dst_addr, *mmaped_addr;
    u_int8_t *src_addr = data;
    int channels;
    if(pcm->flags & PCM_MONO)
        channels = 1;
    else if(pcm->flags & PCM_QUAD)
        channels = 4;
    else if(pcm->flags & PCM_5POINT1)
        channels = 6;
    else if(pcm->flags & PCM_7POINT1)
        channels = 8;
    else
        channels = 2;

    dst_addr = dst_address(pcm);

    frames = frames * channels *2 ;

    while (frames-- > 0) {
        *(u_int8_t*)dst_addr = *(const u_int8_t*)src_addr;
         src_addr++;
         dst_addr++;
    }
    return 0;
}

int mmap_transfer_capture(struct pcm *pcm, void *data, unsigned offset,
                          long frames)
{
    struct snd_pcm_sync_ptr *sync_ptr = pcm->sync_ptr;
    unsigned long pcm_offset = 0;
    unsigned size;
    u_int8_t *dst_addr, *mmaped_addr;
    u_int8_t *src_addr;
    int channels;
    unsigned int tmp;

    if(pcm->flags & PCM_MONO)
        channels = 1;
    else if(pcm->flags & PCM_QUAD)
        channels = 4;
    else if(pcm->flags & PCM_5POINT1)
        channels = 6;
    else if(pcm->flags & PCM_7POINT1)
        channels = 8;
    else
        channels = 2;
    tmp = sync_ptr->c.control.appl_ptr*2*channels;
    pcm_offset = (tmp % (unsigned long)pcm->buffer_size);
    dst_addr = data;
    src_addr = pcm->addr + pcm_offset;
    frames = frames * channels *2 ;

    while (frames-- > 0) {
        *(u_int8_t*)dst_addr = *(const u_int8_t*)src_addr;
         src_addr++;
         dst_addr++;
    }
    return 0;
}

int pcm_prepare(struct pcm *pcm)
{
    if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_PREPARE)) {
           ALOGE("cannot prepare channel: errno =%d\n", -errno);
           return -errno;
    }
    pcm->running = 1;
    return 0;
}

static int pcm_write_mmap(struct pcm *pcm, void *data, unsigned count)
{
    long frames;
    int err;
    int bytes_written;
    int channels;
    if(pcm->flags & PCM_MONO)
        channels = 1;
    else if(pcm->flags & PCM_QUAD)
        channels = 4;
    else if(pcm->flags & PCM_5POINT1)
        channels = 6;
    else if(pcm->flags & PCM_7POINT1)
        channels = 8;
    else
        channels = 2;
    frames = count / (2*channels);

    pcm->sync_ptr->flags = SNDRV_PCM_SYNC_PTR_APPL | SNDRV_PCM_SYNC_PTR_AVAIL_MIN;
    err = sync_ptr(pcm);
    if (err == EPIPE) {
        ALOGE("Failed in sync_ptr\n");
        /* we failed to make our window -- try to restart */
        pcm->underruns++;
        pcm->running = 0;
        pcm_prepare(pcm);
    }
    pcm->sync_ptr->c.control.appl_ptr += frames;
    pcm->sync_ptr->flags = 0;

    err = sync_ptr(pcm);
    if (err == EPIPE) {
        ALOGE("Failed in sync_ptr 2 \n");
        /* we failed to make our window -- try to restart */
        pcm->underruns++;
        pcm->running = 0;
        pcm_prepare(pcm);
    }
    bytes_written = pcm->sync_ptr->c.control.appl_ptr - pcm->sync_ptr->s.status.hw_ptr;
    if ((bytes_written >= pcm->sw_p->start_threshold) && (!pcm->start)) {
        if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_START)) {
            err = -errno;
            if (errno == EPIPE) {
                ALOGE("Failed in SNDRV_PCM_IOCTL_START\n");
                /* we failed to make our window -- try to restart */
                pcm->underruns++;
                pcm->running = 0;
                pcm_prepare(pcm);
            } else {
                ALOGE("Error no %d \n", errno);
                return -errno;
            }
        } else {
             ALOGD(" start\n");
             pcm->start = 1;
        }
    }
    return 0;
}

static int pcm_write_nmmap(struct pcm *pcm, void *data, unsigned count)
{
    struct snd_xferi x;
    int channels;
    if(pcm->flags & PCM_MONO)
        channels = 1;
    else if(pcm->flags & PCM_QUAD)
        channels = 4;
    else if(pcm->flags & PCM_5POINT1)
        channels = 6;
    else if(pcm->flags & PCM_7POINT1)
        channels = 8;
    else
        channels = 2;

    if (pcm->flags & PCM_IN)
        return -EINVAL;
    x.buf = data;
    x.frames =  (count / (channels * 2)) ;

    for (;;) {
        if (!pcm->running) {
            if (pcm_prepare(pcm))
                return -errno;
        }
        if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_WRITEI_FRAMES, &x)) {
            if (errno == EPIPE) {
                    /* we failed to make our window -- try to restart */
                ALOGE("Underrun Error\n");
                pcm->underruns++;
                pcm->running = 0;
                continue;
            }
            return -errno;
        }
        if (pcm->flags & DEBUG_ON)
          ALOGV("Sent frame\n");
        return 0;
    }
}

int pcm_write(struct pcm *pcm, void *data, unsigned count)
{
     if (pcm->flags & PCM_MMAP)
         return pcm_write_mmap(pcm, data, count);
     else
         return pcm_write_nmmap(pcm, data, count);
}

int pcm_read(struct pcm *pcm, void *data, unsigned count)
{
    struct snd_xferi x;

    if (!(pcm->flags & PCM_IN))
        return -EINVAL;

    x.buf = data;
    if (pcm->flags & PCM_MONO) {
        x.frames = (count / 2);
    } else if (pcm->flags & PCM_QUAD) {
        x.frames = (count / 8);
    } else if (pcm->flags & PCM_5POINT1) {
        x.frames = (count / 12);
    } else if (pcm->flags & PCM_7POINT1) {
        x.frames = (count / 16);
    } else {
        x.frames = (count / 4);
    }

    for (;;) {
        if (!pcm->running) {
            if (pcm_prepare(pcm))
                return -errno;
            if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_START)) {
                ALOGE("Arec:SNDRV_PCM_IOCTL_START failed\n");
                return -errno;
            }
            pcm->running = 1;
        }
        if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_READI_FRAMES, &x)) {
            if (errno == EPIPE) {
                /* we failed to make our window -- try to restart */
                ALOGE("Arec:Overrun Error\n");
                pcm->underruns++;
                pcm->running = 0;
                continue;
            } else if (errno == ESTRPIPE) {
                ALOGV("Resume from suspended\n");
                for (;;) {
                    if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_RESUME)) {
                        if (errno == EAGAIN ) {
                            if (pcm_prepare(pcm))
                                return -errno;
                        }
                        /* send resume command again */
                        continue;
                    } else
                        break;
                }
                continue;
            }
            ALOGE("Arec: error%d\n", errno);
            return -errno;
        }
        return 0;
    }
}

static struct pcm bad_pcm = {
    .fd = -1,
};

static int enable_timer(struct pcm *pcm) {

    pcm->timer_fd = open("/dev/snd/timer", O_RDWR | O_NONBLOCK);
    if (pcm->timer_fd < 0) {
       close(pcm->fd);
       ALOGE("cannot open timer device 'timer'");
       return &bad_pcm;
    }
    int arg = 1;
    struct snd_timer_params timer_param;
    struct snd_timer_select sel;
    if (ioctl(pcm->timer_fd, SNDRV_TIMER_IOCTL_TREAD, &arg) < 0) {
           ALOGE("extended read is not supported (SNDRV_TIMER_IOCTL_TREAD)\n");
    }
    memset(&sel, 0, sizeof(sel));
    sel.id.dev_class = SNDRV_TIMER_CLASS_PCM;
    sel.id.dev_sclass = SNDRV_TIMER_SCLASS_NONE;
    sel.id.card = pcm->card_no;
    sel.id.device = pcm->device_no;
    if (pcm->flags & PCM_IN)
        sel.id.subdevice = 1;
    else
        sel.id.subdevice = 0;

    if (pcm->flags & DEBUG_ON) {
        ALOGD("sel.id.dev_class= %d\n", sel.id.dev_class);
        ALOGD("sel.id.dev_sclass = %d\n", sel.id.dev_sclass);
        ALOGD("sel.id.card = %d\n", sel.id.card);
        ALOGD("sel.id.device = %d\n", sel.id.device);
        ALOGD("sel.id.subdevice = %d\n", sel.id.subdevice);
    }
    if (ioctl(pcm->timer_fd, SNDRV_TIMER_IOCTL_SELECT, &sel) < 0) {
          ALOGE("SNDRV_TIMER_IOCTL_SELECT failed.\n");
          close(pcm->timer_fd);
          close(pcm->fd);
          return &bad_pcm;
    }
    memset(&timer_param, 0, sizeof(struct snd_timer_params));
    timer_param.flags |= SNDRV_TIMER_PSFLG_AUTO;
    timer_param.ticks = 1;
    timer_param.filter = (1<<SNDRV_TIMER_EVENT_MSUSPEND) | (1<<SNDRV_TIMER_EVENT_MRESUME) | (1<<SNDRV_TIMER_EVENT_TICK);

    if (ioctl(pcm->timer_fd, SNDRV_TIMER_IOCTL_PARAMS, &timer_param)< 0) {
           ALOGE("SNDRV_TIMER_IOCTL_PARAMS failed\n");
    }
    if (ioctl(pcm->timer_fd, SNDRV_TIMER_IOCTL_START) < 0) {
           close(pcm->timer_fd);
           ALOGE("SNDRV_TIMER_IOCTL_START failed\n");
    }
    return 0;
}

static int disable_timer(struct pcm *pcm) {
     if (pcm == &bad_pcm)
         return 0;
     if (ioctl(pcm->timer_fd, SNDRV_TIMER_IOCTL_STOP) < 0)
         ALOGE("SNDRV_TIMER_IOCTL_STOP failed\n");
     return close(pcm->timer_fd);
}

int pcm_close(struct pcm *pcm)
{
    if (pcm == &bad_pcm)
        return 0;

    if (pcm->flags & PCM_MMAP) {
        disable_timer(pcm);
        if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_DROP) < 0) {
            ALOGE("Reset failed");
        }

        if (munmap(pcm->addr, pcm->buffer_size))
            ALOGE("munmap failed");

        if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_HW_FREE) < 0) {
            ALOGE("HW_FREE failed");
        }
    }

    if (pcm->fd >= 0)
        close(pcm->fd);
    pcm->running = 0;
    pcm->buffer_size = 0;
    pcm->fd = -1;
    if (pcm->sw_p)
        free(pcm->sw_p);
    if (pcm->hw_p)
        free(pcm->hw_p);
    if (pcm->sync_ptr)
        free(pcm->sync_ptr);
    free(pcm);
    return 0;
}

struct pcm *pcm_open(unsigned flags, char *device)
{
    char dname[19];
    struct pcm *pcm;
    struct snd_pcm_info info;
    struct snd_pcm_hw_params params;
    struct snd_pcm_sw_params sparams;
    unsigned period_sz;
    unsigned period_cnt;
    char *tmp;

    if (flags & DEBUG_ON) {
        ALOGV("pcm_open(0x%08x)",flags);
        ALOGV("device %s\n",device);
    }

    pcm = calloc(1, sizeof(struct pcm));
    if (!pcm)
        return &bad_pcm;

    tmp = device+4;
    if ((strncmp(device, "hw:",3) != 0) || (strncmp(tmp, ",",1) != 0)){
        ALOGE("Wrong device fromat\n");
        free(pcm);
        return -EINVAL;
    }

    if (flags & PCM_IN) {
        strlcpy(dname, "/dev/snd/pcmC", sizeof(dname));
        tmp = device+3;
        strlcat(dname, tmp, (2+strlen(dname))) ;
        pcm->card_no = atoi(tmp);
        strlcat(dname, "D", (sizeof("D")+strlen(dname)));
        tmp = device+5;
        pcm->device_no = atoi(tmp);
	/* should be safe to assume pcm dev ID never exceed 99 */
        if (pcm->device_no > 9)
            strlcat(dname, tmp, (3+strlen(dname)));
        else
            strlcat(dname, tmp, (2+strlen(dname)));
        strlcat(dname, "c", (sizeof("c")+strlen(dname)));
    } else {
        strlcpy(dname, "/dev/snd/pcmC", sizeof(dname));
        tmp = device+3;
        strlcat(dname, tmp, (2+strlen(dname))) ;
        pcm->card_no = atoi(tmp);
        strlcat(dname, "D", (sizeof("D")+strlen(dname)));
        tmp = device+5;
        pcm->device_no = atoi(tmp);
	/* should be safe to assume pcm dev ID never exceed 99 */
        if (pcm->device_no > 9)
            strlcat(dname, tmp, (3+strlen(dname)));
        else
            strlcat(dname, tmp, (2+strlen(dname)));
        strlcat(dname, "p", (sizeof("p")+strlen(dname)));
    }
    if (pcm->flags & DEBUG_ON)
        ALOGV("Device name %s\n", dname);

    pcm->sync_ptr = calloc(1, sizeof(struct snd_pcm_sync_ptr));
    if (!pcm->sync_ptr) {
         free(pcm);
         return &bad_pcm;
    }
    pcm->flags = flags;

    pcm->fd = open(dname, O_RDWR|O_NONBLOCK);
    if (pcm->fd < 0) {
        free(pcm->sync_ptr);
        free(pcm);
        ALOGE("cannot open device '%s', errno %d", dname, errno);
        return &bad_pcm;
    }

    if (fcntl(pcm->fd, F_SETFL, fcntl(pcm->fd, F_GETFL) &
            ~O_NONBLOCK) < 0) {
        close(pcm->fd);
        free(pcm->sync_ptr);
        free(pcm);
        ALOGE("failed to change the flag, errno %d", errno);
        return &bad_pcm;
    }

    if (pcm->flags & PCM_MMAP)
        enable_timer(pcm);

    if (pcm->flags & DEBUG_ON)
        ALOGV("pcm_open() %s\n", dname);
    if (ioctl(pcm->fd, SNDRV_PCM_IOCTL_INFO, &info)) {
        ALOGE("cannot get info - %s", dname);
    }
    if (pcm->flags & DEBUG_ON)
       info_dump(&info);

    return pcm;
}

int pcm_ready(struct pcm *pcm)
{
    return pcm->fd >= 0;
}

int pcm_set_channel_map(struct pcm *pcm, struct mixer *mixer,
                        int max_channels, char *chmap)
{
    struct mixer_ctl *ctl;
    char control_name[44]; // max length of name is 44 as defined
    char device_num[3]; // device number upto 2 digit
    char **set_values;
    int i;

    ALOGV("pcm_set_channel_map");
    set_values = (char**)malloc(max_channels*sizeof(char*));
    if(set_values) {
        for(i=0; i< max_channels; i++) {
            set_values[i] = (char*)malloc(4*sizeof(char));
            if(set_values[i]) {
                sprintf(set_values[i],"%d",chmap[i]);
            } else {
                ALOGE("memory allocation for set channel map failed");
                return -1;
            }
        }
    } else {
        ALOGE("memory allocation for set channel map failed");
        return -1;
    }
    strlcpy(control_name, "Playback Channel Map", sizeof(control_name));
    sprintf(device_num, "%d", pcm->device_no);
    strcat(control_name, device_num);
    ALOGV("pcm_set_channel_map: control name:%s", control_name);
    ctl = mixer_get_control(mixer, control_name, 0);
    if(ctl == NULL) {
        ALOGE(stderr, "Could not get the mixer control\n");
        return -1;
    }
    mixer_ctl_set_value(ctl, max_channels, set_values);
    for(i=0; i< max_channels; i++)
        if(set_values[i])
            free(set_values[i]);
    if(set_values)
        free(set_values);
    return 0;
}