| /* |
| * 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_qcp.h> |
| #include <mach/msm_qdsp6_audio.h> |
| #include "dal_audio_format.h" |
| #include <mach/debug_mm.h> |
| |
| #define EVRC_FC_BUFF_CNT 10 |
| #define EVRC_READ_TIMEOUT 2000 |
| struct evrc_fc_buff { |
| struct mutex lock; |
| int empty; |
| void *data; |
| int size; |
| int actual_size; |
| }; |
| |
| struct evrc_fc { |
| struct task_struct *task; |
| wait_queue_head_t fc_wq; |
| struct evrc_fc_buff fc_buff[EVRC_FC_BUFF_CNT]; |
| int buff_index; |
| }; |
| |
| struct evrc { |
| struct mutex lock; |
| struct msm_audio_evrc_enc_config cfg; |
| struct msm_audio_stream_config str_cfg; |
| struct audio_client *audio_client; |
| struct msm_voicerec_mode voicerec_mode; |
| struct evrc_fc *evrc_fc; |
| }; |
| |
| |
| static int q6_evrc_flowcontrol(void *data) |
| { |
| struct audio_client *ac; |
| struct audio_buffer *ab; |
| struct evrc *evrc = data; |
| int buff_index = 0; |
| int xfer = 0; |
| struct evrc_fc *fc; |
| |
| |
| ac = evrc->audio_client; |
| fc = evrc->evrc_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 >= EVRC_FC_BUFF_CNT) |
| buff_index = 0; |
| |
| ab->used = 1; |
| |
| q6audio_read(ac, ab); |
| ac->cpu_buf ^= 1; |
| } |
| |
| return 0; |
| } |
| static long q6_evrc_in_ioctl(struct file *file, unsigned int cmd, |
| unsigned long arg) |
| { |
| struct evrc *evrc = file->private_data; |
| int rc = 0; |
| int i = 0; |
| struct evrc_fc *fc; |
| int size = 0; |
| |
| mutex_lock(&evrc->lock); |
| switch (cmd) { |
| case AUDIO_SET_VOLUME: |
| pr_debug("[%s:%s] SET_VOLUME\n", __MM_FILE__, __func__); |
| 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 (evrc->audio_client) { |
| rc = -EBUSY; |
| pr_err("[%s:%s] active session already existing\n", |
| __MM_FILE__, __func__); |
| break; |
| } else { |
| evrc->audio_client = q6audio_open_qcp( |
| evrc->str_cfg.buffer_size, |
| evrc->cfg.min_bit_rate, |
| evrc->cfg.max_bit_rate, |
| evrc->voicerec_mode.rec_mode, |
| ADSP_AUDIO_FORMAT_EVRC_FS, |
| acdb_id); |
| |
| if (!evrc->audio_client) { |
| pr_err("[%s:%s] evrc open session failed\n", |
| __MM_FILE__, __func__); |
| kfree(evrc); |
| rc = -ENOMEM; |
| break; |
| } |
| } |
| |
| /*allocate flow control buffers*/ |
| fc = evrc->evrc_fc; |
| size = evrc->str_cfg.buffer_size; |
| for (i = 0; i < EVRC_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_evrc_flowcontrol, |
| evrc, "evrc_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(&evrc->voicerec_mode, |
| (void *)arg, sizeof(struct msm_voicerec_mode))) |
| rc = -EFAULT; |
| |
| if (evrc->voicerec_mode.rec_mode != AUDIO_FLAG_READ |
| && evrc->voicerec_mode.rec_mode != |
| AUDIO_FLAG_INCALL_MIXED) { |
| evrc->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, &evrc->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__, evrc->str_cfg.buffer_size, |
| evrc->str_cfg.buffer_count); |
| break; |
| case AUDIO_SET_STREAM_CONFIG: |
| if (copy_from_user(&evrc->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__, evrc->str_cfg.buffer_size, |
| evrc->str_cfg.buffer_count); |
| |
| if (evrc->str_cfg.buffer_size < 23) { |
| pr_err("[%s:%s] Buffer size too small\n", __MM_FILE__, |
| __func__); |
| rc = -EINVAL; |
| break; |
| } |
| |
| if (evrc->str_cfg.buffer_count != 2) |
| pr_info("[%s:%s] Buffer count set to 2\n", __MM_FILE__, |
| __func__); |
| break; |
| case AUDIO_SET_EVRC_ENC_CONFIG: |
| if (copy_from_user(&evrc->cfg, (void *) arg, |
| sizeof(struct msm_audio_evrc_enc_config))) |
| rc = -EFAULT; |
| pr_debug("[%s:%s] SET_EVRC_ENC_CONFIG\n", __MM_FILE__, |
| __func__); |
| |
| if (evrc->cfg.min_bit_rate > 4 || evrc->cfg.min_bit_rate < 1) { |
| pr_err("[%s:%s] invalid min bitrate\n", __MM_FILE__, |
| __func__); |
| rc = -EINVAL; |
| } |
| if (evrc->cfg.max_bit_rate > 4 || evrc->cfg.max_bit_rate < 1) { |
| pr_err("[%s:%s] invalid max bitrate\n", __MM_FILE__, |
| __func__); |
| rc = -EINVAL; |
| } |
| break; |
| case AUDIO_GET_EVRC_ENC_CONFIG: |
| if (copy_to_user((void *) arg, &evrc->cfg, |
| sizeof(struct msm_audio_evrc_enc_config))) |
| rc = -EFAULT; |
| pr_debug("[%s:%s] GET_EVRC_ENC_CONFIG\n", __MM_FILE__, |
| __func__); |
| break; |
| |
| default: |
| rc = -EINVAL; |
| } |
| |
| mutex_unlock(&evrc->lock); |
| pr_debug("[%s:%s] rc = %d\n", __MM_FILE__, __func__, rc); |
| return rc; |
| } |
| |
| static int q6_evrc_in_open(struct inode *inode, struct file *file) |
| { |
| struct evrc *evrc; |
| struct evrc_fc *fc; |
| int i; |
| |
| pr_info("[%s:%s] open\n", __MM_FILE__, __func__); |
| evrc = kmalloc(sizeof(struct evrc), GFP_KERNEL); |
| if (evrc == NULL) { |
| pr_err("[%s:%s] Could not allocate memory for evrc driver\n", |
| __MM_FILE__, __func__); |
| return -ENOMEM; |
| } |
| |
| mutex_init(&evrc->lock); |
| file->private_data = evrc; |
| evrc->audio_client = NULL; |
| evrc->str_cfg.buffer_size = 23; |
| evrc->str_cfg.buffer_count = 2; |
| evrc->cfg.cdma_rate = CDMA_RATE_FULL; |
| evrc->cfg.min_bit_rate = 1; |
| evrc->cfg.max_bit_rate = 4; |
| evrc->voicerec_mode.rec_mode = AUDIO_FLAG_READ; |
| |
| evrc->evrc_fc = kmalloc(sizeof(struct evrc_fc), GFP_KERNEL); |
| if (evrc->evrc_fc == NULL) { |
| pr_err("[%s:%s] Could not allocate memory for evrc_fc\n", |
| __MM_FILE__, __func__); |
| kfree(evrc); |
| return -ENOMEM; |
| } |
| fc = evrc->evrc_fc; |
| fc->task = NULL; |
| fc->buff_index = 0; |
| for (i = 0; i < EVRC_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_evrc_in_read(struct file *file, char __user *buf, |
| size_t count, loff_t *pos) |
| { |
| struct audio_client *ac; |
| const char __user *start = buf; |
| struct evrc *evrc = file->private_data; |
| struct evrc_fc *fc; |
| int xfer = 0; |
| int res = 0; |
| |
| pr_debug("[%s:%s] count = %d\n", __MM_FILE__, __func__, count); |
| mutex_lock(&evrc->lock); |
| ac = evrc->audio_client; |
| if (!ac) { |
| res = -ENODEV; |
| goto fail; |
| } |
| fc = evrc->evrc_fc; |
| while (count > xfer) { |
| /*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(EVRC_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; |
| count -= 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 >= EVRC_FC_BUFF_CNT) |
| fc->buff_index = 0; |
| } |
| res = buf - start; |
| |
| fail: |
| mutex_unlock(&evrc->lock); |
| |
| return res; |
| } |
| |
| static int q6_evrc_in_release(struct inode *inode, struct file *file) |
| { |
| int rc = 0; |
| struct evrc *evrc = file->private_data; |
| int i = 0; |
| struct evrc_fc *fc; |
| |
| mutex_lock(&evrc->lock); |
| fc = evrc->evrc_fc; |
| kthread_stop(fc->task); |
| fc->task = NULL; |
| /*free flow control buffers*/ |
| for (i = 0; i < EVRC_FC_BUFF_CNT; ++i) { |
| kfree(fc->fc_buff[i].data); |
| fc->fc_buff[i].data = NULL; |
| } |
| kfree(fc); |
| if (evrc->audio_client) |
| rc = q6audio_close(evrc->audio_client); |
| mutex_unlock(&evrc->lock); |
| kfree(evrc); |
| pr_info("[%s:%s] release\n", __MM_FILE__, __func__); |
| return rc; |
| } |
| |
| static const struct file_operations q6_evrc_in_fops = { |
| .owner = THIS_MODULE, |
| .open = q6_evrc_in_open, |
| .read = q6_evrc_in_read, |
| .release = q6_evrc_in_release, |
| .unlocked_ioctl = q6_evrc_in_ioctl, |
| }; |
| |
| struct miscdevice q6_evrc_in_misc = { |
| .minor = MISC_DYNAMIC_MINOR, |
| .name = "msm_evrc_in", |
| .fops = &q6_evrc_in_fops, |
| }; |
| |
| static int __init q6_evrc_in_init(void) |
| { |
| return misc_register(&q6_evrc_in_misc); |
| } |
| |
| device_initcall(q6_evrc_in_init); |