Initial Contribution
msm-2.6.38: tag AU_LINUX_ANDROID_GINGERBREAD.02.03.04.00.142
Signed-off-by: Bryan Huntsman <bryanh@codeaurora.org>
diff --git a/arch/arm/mach-msm/qdsp6/evrc_in.c b/arch/arm/mach-msm/qdsp6/evrc_in.c
new file mode 100644
index 0000000..9fc412b
--- /dev/null
+++ b/arch/arm/mach-msm/qdsp6/evrc_in.c
@@ -0,0 +1,468 @@
+/*
+ * Copyright (C) 2009 Google, Inc.
+ * Copyright (C) 2009 HTC Corporation
+ * Copyright (c) 2010, Code Aurora Forum. 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);