471 lines
12 KiB
C
471 lines
12 KiB
C
|
/*
|
||
|
|
* 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);
|