| /* |
| * Copyright (C) 2009 Google, Inc. |
| * Copyright (C) 2009 HTC Corporation |
| * Copyright (c) 2010, The Linux Foundation. All rights reserved. |
| * |
| * This software is licensed under the terms of the GNU General Public |
| * License version 2, as published by the Free Software Foundation, and |
| * may be copied, distributed, and modified under those terms. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| */ |
| |
| #include <linux/slab.h> |
| #include <linux/fs.h> |
| #include <linux/module.h> |
| #include <linux/miscdevice.h> |
| #include <linux/mutex.h> |
| #include <linux/sched.h> |
| #include <linux/wait.h> |
| #include <linux/uaccess.h> |
| #include <linux/kthread.h> |
| #include <linux/time.h> |
| #include <linux/wait.h> |
| |
| #include <linux/msm_audio.h> |
| #include <linux/msm_audio_aac.h> |
| #include <mach/msm_qdsp6_audio.h> |
| #include <mach/debug_mm.h> |
| |
| #define AAC_FC_BUFF_CNT 10 |
| #define AAC_READ_TIMEOUT 2000 |
| struct aac_fc_buff { |
| struct mutex lock; |
| int empty; |
| void *data; |
| int size; |
| int actual_size; |
| }; |
| |
| struct aac_fc { |
| struct task_struct *task; |
| wait_queue_head_t fc_wq; |
| struct aac_fc_buff fc_buff[AAC_FC_BUFF_CNT]; |
| int buff_index; |
| }; |
| struct aac { |
| struct mutex lock; |
| struct msm_audio_aac_enc_config cfg; |
| struct msm_audio_stream_config str_cfg; |
| struct audio_client *audio_client; |
| struct msm_voicerec_mode voicerec_mode; |
| struct aac_fc *aac_fc; |
| }; |
| |
| static int q6_aac_flowcontrol(void *data) |
| { |
| struct audio_client *ac; |
| struct audio_buffer *ab; |
| struct aac *aac = data; |
| int buff_index = 0; |
| int xfer = 0; |
| struct aac_fc *fc; |
| |
| |
| ac = aac->audio_client; |
| fc = aac->aac_fc; |
| if (!ac) { |
| pr_err("[%s:%s] audio_client is NULL\n", __MM_FILE__, __func__); |
| return 0; |
| } |
| |
| while (!kthread_should_stop()) { |
| ab = ac->buf + ac->cpu_buf; |
| if (ab->used) |
| wait_event(ac->wait, (ab->used == 0)); |
| pr_debug("[%s:%s] ab->data = %p, cpu_buf = %d\n", __MM_FILE__, |
| __func__, ab->data, ac->cpu_buf); |
| xfer = ab->actual_size; |
| |
| mutex_lock(&(fc->fc_buff[buff_index].lock)); |
| if (!fc->fc_buff[buff_index].empty) { |
| pr_err("[%s:%s] flow control buffer[%d] not read!\n", |
| __MM_FILE__, __func__, buff_index); |
| } |
| |
| if (fc->fc_buff[buff_index].size < xfer) { |
| pr_err("[%s:%s] buffer %d too small\n", __MM_FILE__, |
| __func__, buff_index); |
| memcpy(fc->fc_buff[buff_index].data, |
| ab->data, fc->fc_buff[buff_index].size); |
| fc->fc_buff[buff_index].empty = 0; |
| fc->fc_buff[buff_index].actual_size = |
| fc->fc_buff[buff_index].size; |
| } else { |
| memcpy(fc->fc_buff[buff_index].data, ab->data, xfer); |
| fc->fc_buff[buff_index].empty = 0; |
| fc->fc_buff[buff_index].actual_size = xfer; |
| } |
| mutex_unlock(&(fc->fc_buff[buff_index].lock)); |
| /*wake up client, if any*/ |
| wake_up(&fc->fc_wq); |
| |
| buff_index++; |
| if (buff_index >= AAC_FC_BUFF_CNT) |
| buff_index = 0; |
| |
| ab->used = 1; |
| |
| q6audio_read(ac, ab); |
| ac->cpu_buf ^= 1; |
| } |
| |
| return 0; |
| } |
| static long q6_aac_in_ioctl(struct file *file, |
| unsigned int cmd, unsigned long arg) |
| { |
| struct aac *aac = file->private_data; |
| int rc = 0; |
| int i = 0; |
| struct aac_fc *fc; |
| int size = 0; |
| |
| mutex_lock(&aac->lock); |
| switch (cmd) { |
| case AUDIO_SET_VOLUME: |
| break; |
| case AUDIO_GET_STATS: |
| { |
| struct msm_audio_stats stats; |
| pr_debug("[%s:%s] GET_STATS\n", __MM_FILE__, __func__); |
| memset(&stats, 0, sizeof(stats)); |
| if (copy_to_user((void *) arg, &stats, sizeof(stats))) |
| return -EFAULT; |
| return 0; |
| } |
| case AUDIO_START: |
| { |
| uint32_t acdb_id; |
| pr_debug("[%s:%s] AUDIO_START\n", __MM_FILE__, __func__); |
| if (arg == 0) { |
| acdb_id = 0; |
| } else { |
| if (copy_from_user(&acdb_id, (void *) arg, |
| sizeof(acdb_id))) { |
| rc = -EFAULT; |
| break; |
| } |
| } |
| if (aac->audio_client) { |
| rc = -EBUSY; |
| pr_err("[%s:%s] active session already existing\n", |
| __MM_FILE__, __func__); |
| break; |
| } else { |
| aac->audio_client = q6audio_open_aac( |
| aac->str_cfg.buffer_size, |
| aac->cfg.sample_rate, |
| aac->cfg.channels, |
| aac->cfg.bit_rate, |
| aac->cfg.stream_format, |
| aac->voicerec_mode.rec_mode, acdb_id); |
| |
| if (aac->audio_client < 0) { |
| pr_err("[%s:%s] aac open session failed\n", |
| __MM_FILE__, __func__); |
| rc = -ENOMEM; |
| break; |
| } |
| } |
| |
| /*allocate flow control buffers*/ |
| fc = aac->aac_fc; |
| size = ((aac->str_cfg.buffer_size < 1543) ? 1543 : |
| aac->str_cfg.buffer_size); |
| for (i = 0; i < AAC_FC_BUFF_CNT; ++i) { |
| mutex_init(&(fc->fc_buff[i].lock)); |
| fc->fc_buff[i].empty = 1; |
| fc->fc_buff[i].data = kmalloc(size, GFP_KERNEL); |
| if (fc->fc_buff[i].data == NULL) { |
| pr_err("[%s:%s] No memory for FC buffers\n", |
| __MM_FILE__, __func__); |
| rc = -ENOMEM; |
| goto fc_fail; |
| } |
| fc->fc_buff[i].size = size; |
| fc->fc_buff[i].actual_size = 0; |
| } |
| |
| /*create flow control thread*/ |
| fc->task = kthread_run(q6_aac_flowcontrol, |
| aac, "aac_flowcontrol"); |
| if (IS_ERR(fc->task)) { |
| rc = PTR_ERR(fc->task); |
| pr_err("[%s:%s] error creating flow control thread\n", |
| __MM_FILE__, __func__); |
| goto fc_fail; |
| } |
| break; |
| fc_fail: |
| /*free flow control buffers*/ |
| --i; |
| for (; i >= 0; i--) { |
| kfree(fc->fc_buff[i].data); |
| fc->fc_buff[i].data = NULL; |
| } |
| break; |
| } |
| case AUDIO_STOP: |
| pr_debug("[%s:%s] AUDIO_STOP\n", __MM_FILE__, __func__); |
| break; |
| case AUDIO_FLUSH: |
| break; |
| case AUDIO_SET_INCALL: { |
| pr_debug("[%s:%s] SET_INCALL\n", __MM_FILE__, __func__); |
| if (copy_from_user(&aac->voicerec_mode, |
| (void *)arg, sizeof(struct msm_voicerec_mode))) |
| rc = -EFAULT; |
| |
| if (aac->voicerec_mode.rec_mode != AUDIO_FLAG_READ |
| && aac->voicerec_mode.rec_mode != |
| AUDIO_FLAG_INCALL_MIXED) { |
| aac->voicerec_mode.rec_mode = AUDIO_FLAG_READ; |
| pr_err("[%s:%s] Invalid rec_mode\n", __MM_FILE__, |
| __func__); |
| rc = -EINVAL; |
| } |
| break; |
| } |
| case AUDIO_GET_STREAM_CONFIG: |
| if (copy_to_user((void *)arg, &aac->str_cfg, |
| sizeof(struct msm_audio_stream_config))) |
| rc = -EFAULT; |
| pr_debug("[%s:%s] GET_STREAM_CONFIG: buffsz=%d, buffcnt=%d\n", |
| __MM_FILE__, __func__, aac->str_cfg.buffer_size, |
| aac->str_cfg.buffer_count); |
| break; |
| case AUDIO_SET_STREAM_CONFIG: |
| if (copy_from_user(&aac->str_cfg, (void *)arg, |
| sizeof(struct msm_audio_stream_config))) { |
| rc = -EFAULT; |
| break; |
| } |
| pr_debug("[%s:%s] SET_STREAM_CONFIG: buffsz=%d, buffcnt=%d\n", |
| __MM_FILE__, __func__, aac->str_cfg.buffer_size, |
| aac->str_cfg.buffer_count); |
| if (aac->str_cfg.buffer_size < 1543) { |
| pr_err("[%s:%s] Buffer size too small\n", __MM_FILE__, |
| __func__); |
| rc = -EINVAL; |
| break; |
| } |
| if (aac->str_cfg.buffer_count != 2) |
| pr_info("[%s:%s] Buffer count set to 2\n", __MM_FILE__, |
| __func__); |
| |
| break; |
| case AUDIO_SET_AAC_ENC_CONFIG: |
| if (copy_from_user(&aac->cfg, (void *) arg, |
| sizeof(struct msm_audio_aac_enc_config))) { |
| rc = -EFAULT; |
| } |
| pr_debug("[%s:%s] SET_AAC_ENC_CONFIG: channels=%d, rate=%d\n", |
| __MM_FILE__, __func__, aac->cfg.channels, |
| aac->cfg.sample_rate); |
| if (aac->cfg.channels < 1 || aac->cfg.channels > 2) { |
| pr_err("[%s:%s]invalid number of channels\n", |
| __MM_FILE__, __func__); |
| rc = -EINVAL; |
| } |
| if (aac->cfg.sample_rate != 48000) { |
| pr_err("[%s:%s] only 48KHz is supported\n", |
| __MM_FILE__, __func__); |
| rc = -EINVAL; |
| } |
| if (aac->cfg.stream_format != AUDIO_AAC_FORMAT_RAW && |
| aac->cfg.stream_format != AUDIO_AAC_FORMAT_ADTS) { |
| pr_err("[%s:%s] unsupported AAC format\n", __MM_FILE__, |
| __func__); |
| rc = -EINVAL; |
| } |
| break; |
| case AUDIO_GET_AAC_ENC_CONFIG: |
| if (copy_to_user((void *) arg, &aac->cfg, |
| sizeof(struct msm_audio_aac_enc_config))) { |
| rc = -EFAULT; |
| } |
| pr_debug("[%s:%s] GET_AAC_ENC_CONFIG: channels=%d, rate=%d\n", |
| __MM_FILE__, __func__, aac->cfg.channels, |
| aac->cfg.sample_rate); |
| break; |
| default: |
| rc = -EINVAL; |
| } |
| |
| mutex_unlock(&aac->lock); |
| pr_debug("[%s:%s] rc = %d\n", __MM_FILE__, __func__, rc); |
| return rc; |
| } |
| |
| static int q6_aac_in_open(struct inode *inode, struct file *file) |
| { |
| |
| struct aac *aac; |
| struct aac_fc *fc; |
| int i; |
| pr_info("[%s:%s] open\n", __MM_FILE__, __func__); |
| aac = kmalloc(sizeof(struct aac), GFP_KERNEL); |
| if (aac == NULL) { |
| pr_err("[%s:%s] Could not allocate memory for aac driver\n", |
| __MM_FILE__, __func__); |
| return -ENOMEM; |
| } |
| |
| mutex_init(&aac->lock); |
| file->private_data = aac; |
| aac->audio_client = NULL; |
| aac->str_cfg.buffer_size = 1543; |
| aac->str_cfg.buffer_count = 2; |
| aac->cfg.channels = 1; |
| aac->cfg.bit_rate = 192000; |
| aac->cfg.stream_format = AUDIO_AAC_FORMAT_ADTS; |
| aac->cfg.sample_rate = 48000; |
| aac->voicerec_mode.rec_mode = AUDIO_FLAG_READ; |
| |
| aac->aac_fc = kmalloc(sizeof(struct aac_fc), GFP_KERNEL); |
| if (aac->aac_fc == NULL) { |
| pr_err("[%s:%s] Could not allocate memory for aac_fc\n", |
| __MM_FILE__, __func__); |
| kfree(aac); |
| return -ENOMEM; |
| } |
| fc = aac->aac_fc; |
| fc->task = NULL; |
| fc->buff_index = 0; |
| for (i = 0; i < AAC_FC_BUFF_CNT; ++i) { |
| fc->fc_buff[i].data = NULL; |
| fc->fc_buff[i].size = 0; |
| fc->fc_buff[i].actual_size = 0; |
| } |
| /*initialize wait queue head*/ |
| init_waitqueue_head(&fc->fc_wq); |
| return 0; |
| } |
| |
| static ssize_t q6_aac_in_read(struct file *file, char __user *buf, |
| size_t count, loff_t *pos) |
| { |
| struct audio_client *ac; |
| const char __user *start = buf; |
| struct aac *aac = file->private_data; |
| struct aac_fc *fc; |
| int xfer = 0; |
| int res = 0; |
| |
| pr_debug("[%s:%s] count = %d\n", __MM_FILE__, __func__, count); |
| mutex_lock(&aac->lock); |
| ac = aac->audio_client; |
| |
| if (!ac) { |
| res = -ENODEV; |
| goto fail; |
| } |
| fc = aac->aac_fc; |
| |
| /*wait for buffer to full*/ |
| if (fc->fc_buff[fc->buff_index].empty != 0) { |
| res = wait_event_interruptible_timeout(fc->fc_wq, |
| (fc->fc_buff[fc->buff_index].empty == 0), |
| msecs_to_jiffies(AAC_READ_TIMEOUT)); |
| |
| pr_debug("[%s:%s] buff_index = %d\n", __MM_FILE__, |
| __func__, fc->buff_index); |
| if (res == 0) { |
| pr_err("[%s:%s] Timeout!\n", __MM_FILE__, __func__); |
| res = -ETIMEDOUT; |
| goto fail; |
| } else if (res < 0) { |
| pr_err("[%s:%s] Returning on Interrupt\n", __MM_FILE__, |
| __func__); |
| goto fail; |
| } |
| } |
| /*lock the buffer*/ |
| mutex_lock(&(fc->fc_buff[fc->buff_index].lock)); |
| xfer = fc->fc_buff[fc->buff_index].actual_size; |
| |
| if (xfer > count) { |
| mutex_unlock(&(fc->fc_buff[fc->buff_index].lock)); |
| pr_err("[%s:%s] read failed! byte count too small\n", |
| __MM_FILE__, __func__); |
| res = -EINVAL; |
| goto fail; |
| } |
| |
| if (copy_to_user(buf, fc->fc_buff[fc->buff_index].data, xfer)) { |
| mutex_unlock(&(fc->fc_buff[fc->buff_index].lock)); |
| pr_err("[%s:%s] copy_to_user failed at index %d\n", |
| __MM_FILE__, __func__, fc->buff_index); |
| res = -EFAULT; |
| goto fail; |
| } |
| |
| buf += xfer; |
| |
| fc->fc_buff[fc->buff_index].empty = 1; |
| fc->fc_buff[fc->buff_index].actual_size = 0; |
| |
| mutex_unlock(&(fc->fc_buff[fc->buff_index].lock)); |
| ++(fc->buff_index); |
| if (fc->buff_index >= AAC_FC_BUFF_CNT) |
| fc->buff_index = 0; |
| |
| res = buf - start; |
| fail: |
| mutex_unlock(&aac->lock); |
| |
| return res; |
| } |
| |
| static int q6_aac_in_release(struct inode *inode, struct file *file) |
| { |
| int rc = 0; |
| struct aac *aac = file->private_data; |
| int i = 0; |
| struct aac_fc *fc; |
| |
| mutex_lock(&aac->lock); |
| fc = aac->aac_fc; |
| kthread_stop(fc->task); |
| fc->task = NULL; |
| |
| /*free flow control buffers*/ |
| for (i = 0; i < AAC_FC_BUFF_CNT; ++i) { |
| kfree(fc->fc_buff[i].data); |
| fc->fc_buff[i].data = NULL; |
| } |
| kfree(fc); |
| if (aac->audio_client) |
| rc = q6audio_close(aac->audio_client); |
| mutex_unlock(&aac->lock); |
| kfree(aac); |
| pr_info("[%s:%s] release\n", __MM_FILE__, __func__); |
| return rc; |
| } |
| |
| static const struct file_operations q6_aac_in_fops = { |
| .owner = THIS_MODULE, |
| .open = q6_aac_in_open, |
| .read = q6_aac_in_read, |
| .release = q6_aac_in_release, |
| .unlocked_ioctl = q6_aac_in_ioctl, |
| }; |
| |
| struct miscdevice q6_aac_in_misc = { |
| .minor = MISC_DYNAMIC_MINOR, |
| .name = "msm_aac_in", |
| .fops = &q6_aac_in_fops, |
| }; |
| |
| static int __init q6_aac_in_init(void) |
| { |
| return misc_register(&q6_aac_in_misc); |
| } |
| |
| device_initcall(q6_aac_in_init); |