/arch/arm/mach-fsm/qdsp6/pcm_out.c
https://bitbucket.org/sammyz/iscream_thunderc-2.6.35-rebase · C · 242 lines · 199 code · 28 blank · 15 comment · 32 complexity · 8681c9cc15d28d3200a483a53d0d6517 MD5 · raw file
- /* arch/arm/mach-msm/qdsp6/pcm_out.c
- *
- * Copyright (C) 2009 Google, Inc.
- * Author: Brian Swetland <swetland@google.com>
- *
- * 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/wait.h>
- #include <linux/uaccess.h>
- #include <linux/msm_audio.h>
- #include <mach/msm_qdsp6_audio.h>
- #include <mach/debug_mm.h>
- void audio_client_dump(struct audio_client *ac);
- #define BUFSZ (3072)
- struct pcm {
- struct mutex lock;
- struct audio_client *ac;
- uint32_t sample_rate;
- uint32_t channel_count;
- size_t buffer_size;
- };
- static long pcm_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
- {
- struct pcm *pcm = file->private_data;
- int rc = 0;
- if (cmd == AUDIO_GET_STATS) {
- struct msm_audio_stats stats;
- memset(&stats, 0, sizeof(stats));
- if (copy_to_user((void*) arg, &stats, sizeof(stats)))
- return -EFAULT;
- return 0;
- }
- mutex_lock(&pcm->lock);
- switch (cmd) {
- case AUDIO_SET_VOLUME: {
- int vol;
- if (copy_from_user(&vol, (void*) arg, sizeof(vol))) {
- rc = -EFAULT;
- break;
- }
- rc = q6audio_set_stream_volume(pcm->ac, vol);
- break;
- }
- case AUDIO_START: {
- uint32_t acdb_id;
- if (arg == 0) {
- acdb_id = 0;
- } else if (copy_from_user(&acdb_id, (void*) arg, sizeof(acdb_id))) {
- pr_info("[%s:%s] copy acdb_id from user failed\n",
- __MM_FILE__, __func__);
- rc = -EFAULT;
- break;
- }
- if (pcm->ac) {
- rc = -EBUSY;
- } else {
- pcm->ac = q6audio_open_pcm(pcm->buffer_size,
- pcm->sample_rate,
- pcm->channel_count,
- AUDIO_FLAG_WRITE, acdb_id);
- if (!pcm->ac)
- rc = -ENOMEM;
- }
- break;
- }
- case AUDIO_STOP:
- break;
- case AUDIO_FLUSH:
- break;
- case AUDIO_SET_CONFIG: {
- struct msm_audio_config config;
- if (pcm->ac) {
- rc = -EBUSY;
- break;
- }
- if (copy_from_user(&config, (void*) arg, sizeof(config))) {
- rc = -EFAULT;
- break;
- }
- if (config.channel_count < 1 || config.channel_count > 2) {
- rc = -EINVAL;
- break;
- }
- if (config.sample_rate < 8000 || config.sample_rate > 48000) {
- rc = -EINVAL;
- break;
- }
- if (config.buffer_size < 128 || config.buffer_size > 8192) {
- rc = -EINVAL;
- break;
- }
- pcm->sample_rate = config.sample_rate;
- pcm->channel_count = config.channel_count;
- pcm->buffer_size = config.buffer_size;
- break;
- }
- case AUDIO_GET_CONFIG: {
- struct msm_audio_config config;
- config.buffer_size = pcm->buffer_size;
- config.buffer_count = 2;
- 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_SET_EQ: {
- struct msm_audio_eq_stream_config eq_config;
- if (copy_from_user(&eq_config, (void *) arg,
- sizeof(eq_config))) {
- rc = -EFAULT;
- break;
- }
- rc = q6audio_set_stream_eq_pcm(pcm->ac, (void *) &eq_config);
- break;
- }
- default:
- rc = -EINVAL;
- }
- mutex_unlock(&pcm->lock);
- return rc;
- }
- static int pcm_open(struct inode *inode, struct file *file)
- {
- struct pcm *pcm;
- pr_info("[%s:%s] open\n", __MM_FILE__, __func__);
- pcm = kzalloc(sizeof(struct pcm), GFP_KERNEL);
- if (!pcm)
- return -ENOMEM;
- mutex_init(&pcm->lock);
- pcm->channel_count = 2;
- pcm->sample_rate = 44100;
- pcm->buffer_size = BUFSZ;
- file->private_data = pcm;
- return 0;
- }
- static ssize_t pcm_write(struct file *file, const char __user *buf,
- size_t count, loff_t *pos)
- {
- struct pcm *pcm = file->private_data;
- struct audio_client *ac;
- struct audio_buffer *ab;
- const char __user *start = buf;
- int xfer;
- if (!pcm->ac)
- pcm_ioctl(file, AUDIO_START, 0);
- ac = pcm->ac;
- if (!ac)
- return -ENODEV;
- while (count > 0) {
- ab = ac->buf + ac->cpu_buf;
- if (ab->used)
- if (!wait_event_timeout(ac->wait, (ab->used == 0), 5*HZ)) {
- audio_client_dump(ac);
- pr_err("[%s:%s] timeout. dsp dead?\n",
- __MM_FILE__, __func__);
- q6audio_dsp_not_responding();
- }
- xfer = count;
- if (xfer > ab->size)
- xfer = ab->size;
- if (copy_from_user(ab->data, buf, xfer))
- return -EFAULT;
- buf += xfer;
- count -= xfer;
- ab->used = 1;
- ab->actual_size = xfer;
- q6audio_write(ac, ab);
- ac->cpu_buf ^= 1;
- }
- return buf - start;
- }
- static int pcm_release(struct inode *inode, struct file *file)
- {
- struct pcm *pcm = file->private_data;
- if (pcm->ac)
- q6audio_close(pcm->ac);
- kfree(pcm);
- pr_info("[%s:%s] release\n", __MM_FILE__, __func__);
- return 0;
- }
- static struct file_operations pcm_fops = {
- .owner = THIS_MODULE,
- .open = pcm_open,
- .write = pcm_write,
- .release = pcm_release,
- .unlocked_ioctl = pcm_ioctl,
- };
- struct miscdevice pcm_misc = {
- .minor = MISC_DYNAMIC_MINOR,
- .name = "msm_pcm_out",
- .fops = &pcm_fops,
- };
- static int __init pcm_init(void) {
- return misc_register(&pcm_misc);
- }
- device_initcall(pcm_init);