M7350/kernel/arch/arm/mach-msm/qdsp6v2/pcm_in.c

495 lines
11 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-2012, 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/fs.h>
#include <linux/module.h>
#include <linux/miscdevice.h>
#include <linux/mutex.h>
#include <linux/sched.h>
#include <linux/uaccess.h>
#include <linux/spinlock.h>
#include <linux/slab.h>
#include <linux/wait.h>
#include <linux/msm_audio.h>
#include <linux/pm_qos.h>
#include <asm/atomic.h>
#include <mach/debug_mm.h>
#include <mach/qdsp6v2/audio_dev_ctl.h>
#include <sound/q6asm.h>
#include <sound/apr_audio.h>
#include <linux/wakelock.h>
#include <mach/cpuidle.h>
#define MAX_BUF 4
#define BUFSZ (480 * 8)
#define BUFFER_SIZE_MULTIPLE 4
#define MIN_BUFFER_SIZE 160
#define VOC_REC_NONE 0xFF
struct pcm {
struct mutex lock;
struct mutex read_lock;
wait_queue_head_t wait;
spinlock_t dsp_lock;
struct audio_client *ac;
uint32_t sample_rate;
uint32_t channel_count;
uint32_t buffer_size;
uint32_t buffer_count;
uint32_t rec_mode;
uint32_t in_frame_info[MAX_BUF][2];
atomic_t in_count;
atomic_t in_enabled;
atomic_t in_opened;
atomic_t in_stopped;
struct wake_lock wakelock;
struct pm_qos_request pm_qos_req;
};
static void pcm_in_get_dsp_buffers(struct pcm*,
uint32_t token, uint32_t *payload);
void pcm_in_cb(uint32_t opcode, uint32_t token,
uint32_t *payload, void *priv)
{
struct pcm *pcm = (struct pcm *) priv;
unsigned long flags;
spin_lock_irqsave(&pcm->dsp_lock, flags);
switch (opcode) {
case ASM_DATA_EVENT_READ_DONE:
pcm_in_get_dsp_buffers(pcm, token, payload);
break;
case RESET_EVENTS:
reset_device();
break;
default:
break;
}
spin_unlock_irqrestore(&pcm->dsp_lock, flags);
}
static void pcm_in_prevent_sleep(struct pcm *audio)
{
pr_debug("%s:\n", __func__);
wake_lock(&audio->wakelock);
pm_qos_update_request(&audio->pm_qos_req,
msm_cpuidle_get_deep_idle_latency());
}
static void pcm_in_allow_sleep(struct pcm *audio)
{
pr_debug("%s:\n", __func__);
pm_qos_update_request(&audio->pm_qos_req, PM_QOS_DEFAULT_VALUE);
wake_unlock(&audio->wakelock);
}
static void pcm_in_get_dsp_buffers(struct pcm *pcm,
uint32_t token, uint32_t *payload)
{
pcm->in_frame_info[token][0] = payload[7];
pcm->in_frame_info[token][1] = payload[3];
if (atomic_read(&pcm->in_count) <= pcm->buffer_count)
atomic_inc(&pcm->in_count);
wake_up(&pcm->wait);
}
static int pcm_in_enable(struct pcm *pcm)
{
if (atomic_read(&pcm->in_enabled))
return 0;
return q6asm_run(pcm->ac, 0, 0, 0);
}
static int pcm_in_disable(struct pcm *pcm)
{
int rc = 0;
if (atomic_read(&pcm->in_opened)) {
atomic_set(&pcm->in_enabled, 0);
atomic_set(&pcm->in_opened, 0);
rc = q6asm_cmd(pcm->ac, CMD_CLOSE);
atomic_set(&pcm->in_stopped, 1);
memset(pcm->in_frame_info, 0,
sizeof(char) * pcm->buffer_count * 2);
wake_up(&pcm->wait);
}
return rc;
}
static int config(struct pcm *pcm)
{
int rc = 0;
pr_debug("%s: pcm prefill, buffer_size = %d\n", __func__,
pcm->buffer_size);
rc = q6asm_audio_client_buf_alloc(OUT, pcm->ac,
pcm->buffer_size, pcm->buffer_count);
if (rc < 0) {
pr_err("Audio Start: Buffer Allocation failed \
rc = %d\n", rc);
goto fail;
}
rc = q6asm_enc_cfg_blk_pcm(pcm->ac, pcm->sample_rate,
pcm->channel_count);
if (rc < 0) {
pr_err("%s: cmd media format block failed", __func__);
goto fail;
}
fail:
return rc;
}
static long pcm_in_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
struct pcm *pcm = file->private_data;
int rc = 0;
mutex_lock(&pcm->lock);
switch (cmd) {
case AUDIO_SET_VOLUME:
break;
case AUDIO_GET_STATS: {
struct msm_audio_stats stats;
memset(&stats, 0, sizeof(stats));
if (copy_to_user((void *) arg, &stats, sizeof(stats)))
rc = -EFAULT;
break;
}
case AUDIO_START: {
int cnt = 0;
if (atomic_read(&pcm->in_enabled)) {
pr_info("%s:AUDIO_START already over\n", __func__);
rc = 0;
break;
}
rc = config(pcm);
if (rc) {
pr_err("%s: IN Configuration failed\n", __func__);
rc = -EFAULT;
break;
}
rc = pcm_in_enable(pcm);
if (rc) {
pr_err("%s: In Enable failed\n", __func__);
rc = -EFAULT;
break;
}
pcm_in_prevent_sleep(pcm);
atomic_set(&pcm->in_enabled, 1);
while (cnt++ < pcm->buffer_count)
q6asm_read(pcm->ac);
pr_info("%s: AUDIO_START session id[%d]\n", __func__,
pcm->ac->session);
if (pcm->rec_mode != VOC_REC_NONE)
msm_enable_incall_recording(pcm->ac->session,
pcm->rec_mode, pcm->sample_rate, pcm->channel_count);
break;
}
case AUDIO_GET_SESSION_ID: {
if (copy_to_user((void *) arg, &pcm->ac->session,
sizeof(unsigned short)))
rc = -EFAULT;
break;
}
case AUDIO_STOP:
break;
case AUDIO_FLUSH:
break;
case AUDIO_SET_CONFIG: {
struct msm_audio_config config;
if (copy_from_user(&config, (void *) arg, sizeof(config))) {
rc = -EFAULT;
break;
}
pr_debug("%s: SET_CONFIG: buffer_size:%d channel_count:%d"
"sample_rate:%d, buffer_count:%d\n", __func__,
config.buffer_size, config.channel_count,
config.sample_rate, config.buffer_count);
if (!config.channel_count || config.channel_count > 2) {
rc = -EINVAL;
break;
}
if (config.sample_rate < 8000 || config.sample_rate > 48000) {
rc = -EINVAL;
break;
}
if ((config.buffer_size % (config.channel_count *
BUFFER_SIZE_MULTIPLE)) ||
(config.buffer_size < MIN_BUFFER_SIZE)) {
pr_err("%s: Buffer Size should be multiple of "
"[4 * no. of channels] and greater than 160\n",
__func__);
rc = -EINVAL;
break;
}
pcm->sample_rate = config.sample_rate;
pcm->channel_count = config.channel_count;
pcm->buffer_size = config.buffer_size;
pcm->buffer_count = config.buffer_count;
break;
}
case AUDIO_GET_CONFIG: {
struct msm_audio_config config;
config.buffer_size = pcm->buffer_size;
config.buffer_count = pcm->buffer_count;
config.sample_rate = pcm->sample_rate;
config.channel_count = pcm->channel_count;
config.unused[0] = 0;
config.unused[1] = 0;
config.unused[2] = 0;
if (copy_to_user((void *) arg, &config, sizeof(config)))
rc = -EFAULT;
break;
}
case AUDIO_ENABLE_AUDPRE: {
uint16_t enable_mask;
if (copy_from_user(&enable_mask, (void *) arg,
sizeof(enable_mask))) {
rc = -EFAULT;
break;
}
if (enable_mask & FLUENCE_ENABLE)
rc = auddev_cfg_tx_copp_topology(pcm->ac->session,
VPM_TX_DM_FLUENCE_COPP_TOPOLOGY);
else
rc = auddev_cfg_tx_copp_topology(pcm->ac->session,
DEFAULT_COPP_TOPOLOGY);
break;
}
case AUDIO_SET_INCALL: {
if (copy_from_user(&pcm->rec_mode,
(void *) arg,
sizeof(pcm->rec_mode))) {
rc = -EFAULT;
pr_err("%s: Error copying in-call mode\n", __func__);
break;
}
if (pcm->rec_mode != VOC_REC_UPLINK &&
pcm->rec_mode != VOC_REC_DOWNLINK &&
pcm->rec_mode != VOC_REC_BOTH) {
rc = -EINVAL;
pcm->rec_mode = VOC_REC_NONE;
pr_err("%s: Invalid %d in-call rec_mode\n",
__func__, pcm->rec_mode);
break;
}
pr_debug("%s: In-call rec_mode %d\n", __func__, pcm->rec_mode);
break;
}
default:
rc = -EINVAL;
break;
}
mutex_unlock(&pcm->lock);
return rc;
}
static int pcm_in_open(struct inode *inode, struct file *file)
{
struct pcm *pcm;
int rc = 0;
char name[24];
pcm = kzalloc(sizeof(struct pcm), GFP_KERNEL);
if (!pcm)
return -ENOMEM;
pcm->channel_count = 1;
pcm->sample_rate = 8000;
pcm->buffer_size = BUFSZ;
pcm->buffer_count = MAX_BUF;
pcm->ac = q6asm_audio_client_alloc((app_cb)pcm_in_cb, (void *)pcm);
if (!pcm->ac) {
pr_err("%s: Could not allocate memory\n", __func__);
rc = -ENOMEM;
goto fail;
}
mutex_init(&pcm->lock);
mutex_init(&pcm->read_lock);
spin_lock_init(&pcm->dsp_lock);
init_waitqueue_head(&pcm->wait);
rc = q6asm_open_read(pcm->ac, FORMAT_LINEAR_PCM);
if (rc < 0) {
pr_err("%s: Cmd Open Failed\n", __func__);
goto fail;
}
atomic_set(&pcm->in_stopped, 0);
atomic_set(&pcm->in_enabled, 0);
atomic_set(&pcm->in_count, 0);
atomic_set(&pcm->in_opened, 1);
snprintf(name, sizeof name, "pcm_in_%x", pcm->ac->session);
wake_lock_init(&pcm->wakelock, WAKE_LOCK_SUSPEND, name);
snprintf(name, sizeof name, "pcm_in_idle_%x", pcm->ac->session);
pm_qos_add_request(&pcm->pm_qos_req, PM_QOS_CPU_DMA_LATENCY,
PM_QOS_DEFAULT_VALUE);
pcm->rec_mode = VOC_REC_NONE;
file->private_data = pcm;
pr_info("%s: pcm in open session id[%d]\n", __func__, pcm->ac->session);
return 0;
fail:
if (pcm->ac)
q6asm_audio_client_free(pcm->ac);
kfree(pcm);
return rc;
}
static ssize_t pcm_in_read(struct file *file, char __user *buf,
size_t count, loff_t *pos)
{
struct pcm *pcm = file->private_data;
const char __user *start = buf;
void *data;
uint32_t offset = 0;
uint32_t size = 0;
uint32_t idx;
int rc = 0;
int len = 0;
if (!atomic_read(&pcm->in_enabled))
return -EFAULT;
mutex_lock(&pcm->read_lock);
while (count > 0) {
rc = wait_event_timeout(pcm->wait,
(atomic_read(&pcm->in_count) ||
atomic_read(&pcm->in_stopped)), 5 * HZ);
if (!rc) {
pr_err("%s: wait_event_timeout failed\n", __func__);
goto fail;
}
if (atomic_read(&pcm->in_stopped) &&
!atomic_read(&pcm->in_count)) {
mutex_unlock(&pcm->read_lock);
return 0;
}
data = q6asm_is_cpu_buf_avail(OUT, pcm->ac, &size, &idx);
if (count >= size)
len = size;
else {
len = count;
pr_err("%s: short read data[%p]bytesavail[%d]"
"bytesrequest[%d]"
"bytesrejected%d]\n",\
__func__, data, size,
count, (size - count));
}
if ((len) && data) {
offset = pcm->in_frame_info[idx][1];
if (copy_to_user(buf, data+offset, len)) {
pr_err("%s copy_to_user failed len[%d]\n",
__func__, len);
rc = -EFAULT;
goto fail;
}
count -= len;
buf += len;
}
atomic_dec(&pcm->in_count);
memset(&pcm->in_frame_info[idx], 0,
sizeof(uint32_t) * 2);
rc = q6asm_read(pcm->ac);
if (rc < 0) {
pr_err("%s q6asm_read fail\n", __func__);
goto fail;
}
rmb();
break;
}
rc = buf-start;
fail:
mutex_unlock(&pcm->read_lock);
return rc;
}
static int pcm_in_release(struct inode *inode, struct file *file)
{
int rc = 0;
struct pcm *pcm = file->private_data;
pr_info("[%s:%s] release session id[%d]\n", __MM_FILE__,
__func__, pcm->ac->session);
mutex_lock(&pcm->lock);
if ((pcm->rec_mode != VOC_REC_NONE) && atomic_read(&pcm->in_enabled)) {
msm_disable_incall_recording(pcm->ac->session, pcm->rec_mode);
pcm->rec_mode = VOC_REC_NONE;
}
/* remove this session from topology list */
auddev_cfg_tx_copp_topology(pcm->ac->session,
DEFAULT_COPP_TOPOLOGY);
mutex_unlock(&pcm->lock);
rc = pcm_in_disable(pcm);
msm_clear_session_id(pcm->ac->session);
q6asm_audio_client_free(pcm->ac);
pcm_in_allow_sleep(pcm);
wake_lock_destroy(&pcm->wakelock);
pm_qos_remove_request(&pcm->pm_qos_req);
kfree(pcm);
return rc;
}
static const struct file_operations pcm_in_fops = {
.owner = THIS_MODULE,
.open = pcm_in_open,
.read = pcm_in_read,
.release = pcm_in_release,
.unlocked_ioctl = pcm_in_ioctl,
};
struct miscdevice pcm_in_misc = {
.minor = MISC_DYNAMIC_MINOR,
.name = "msm_pcm_in",
.fops = &pcm_in_fops,
};
static int __init pcm_in_init(void)
{
return misc_register(&pcm_in_misc);
}
device_initcall(pcm_in_init);