M7350/kernel/arch/arm/mach-msm/qdsp6/evrc_in.c

469 lines
12 KiB
C
Raw Normal View History

2024-09-09 08:52:07 +00:00
/*
* 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);