/* ** Copyright 2010, The Android Open-Source Project ** Copyright (c) 2011-2013, 2015 The Linux Foundation. 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 #include #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__) #define ALOGD(...) fprintf(stderr, __VA_ARGS__) #endif /* ANDROID */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #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<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[13]; 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]) { snprintf(set_values[i], 4*sizeof(char), "%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)); snprintf(device_num, sizeof(device_num), "%d", pcm->device_no); strlcat(control_name, device_num, sizeof(control_name)); 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; }