1 /* arch/arm/mach-msm/qdsp5/audio_aac.c
3 * aac audio decoder device
5 * Copyright (C) 2008 Google, Inc.
6 * Copyright (C) 2008 HTC Corporation
7 * Copyright (c) 2008-2009 QUALCOMM USA, INC.
9 * This software is licensed under the terms of the GNU General Public
10 * License version 2, as published by the Free Software Foundation, and
11 * may be copied, distributed, and modified under those terms.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
20 #include <linux/module.h>
22 #include <linux/miscdevice.h>
23 #include <linux/uaccess.h>
24 #include <linux/kthread.h>
25 #include <linux/wait.h>
26 #include <linux/dma-mapping.h>
28 #include <linux/delay.h>
30 #include <asm/atomic.h>
31 #include <asm/ioctls.h>
34 #include <mach/msm_adsp.h>
35 #include <mach/msm_audio_aac.h>
36 #include <mach/qdsp5/qdsp5audppcmdi.h>
37 #include <mach/qdsp5/qdsp5audppmsg.h>
38 #include <mach/qdsp5/qdsp5audplaycmdi.h>
39 #include <mach/qdsp5/qdsp5audplaymsg.h>
41 /* for queue ids - should be relative to module number*/
45 #define dprintk(format, arg...) \
46 printk(KERN_DEBUG format, ## arg)
48 #define dprintk(format, arg...) do {} while (0)
52 #define DMASZ (BUFSZ * 2)
54 #define AUDPLAY_INVALID_READ_PTR_OFFSET 0xFFFF
55 #define AUDDEC_DEC_AAC 5
57 #define PCM_BUFSZ_MIN 9600 /* Hold one stereo AAC frame */
58 #define PCM_BUF_MAX_COUNT 5 /* DSP only accepts 5 buffers at most
59 but support 2 buffers currently */
60 #define ROUTING_MODE_FTRT 1
61 #define ROUTING_MODE_RT 2
62 /* Decoder status received from AUDPPTASK */
63 #define AUDPP_DEC_STATUS_SLEEP 0
64 #define AUDPP_DEC_STATUS_INIT 1
65 #define AUDPP_DEC_STATUS_CFG 2
66 #define AUDPP_DEC_STATUS_PLAY 3
71 unsigned used; /* Input usage actual DSP produced PCM size */
82 uint8_t out_needed; /* number of buffers the dsp is waiting for */
87 struct mutex write_lock;
88 wait_queue_head_t write_wait;
90 /* Host PCM section */
91 struct buffer in[PCM_BUF_MAX_COUNT];
92 struct mutex read_lock;
93 wait_queue_head_t read_wait; /* Wait queue for read */
94 char *read_data; /* pointer to reader buffer */
95 dma_addr_t read_phys; /* physical address of reader buffer */
96 uint8_t read_next; /* index to input buffers to be read next */
97 uint8_t fill_next; /* index to buffer that DSP should be filling */
98 uint8_t pcm_buf_count; /* number of pcm buffer allocated */
99 /* ---- End of Host PCM section */
101 struct msm_adsp_module *audplay;
103 /* configuration to use on next enable */
104 uint32_t out_sample_rate;
105 uint32_t out_channel_mode;
106 struct msm_audio_aac_config aac_config;
107 struct audmgr audmgr;
109 /* data allocated for various buffers */
113 int rflush; /* Read flush */
114 int wflush; /* Write flush */
118 int stopped; /* set when stopped, cleared on flush */
122 int reserved; /* A byte is being reserved */
123 char rsv_byte; /* Handle odd length user data */
128 uint32_t read_ptr_offset;
131 static int auddec_dsp_config(struct audio *audio, int enable);
132 static void audpp_cmd_cfg_adec_params(struct audio *audio);
133 static void audpp_cmd_cfg_routing_mode(struct audio *audio);
134 static void audplay_send_data(struct audio *audio, unsigned needed);
135 static void audplay_config_hostpcm(struct audio *audio);
136 static void audplay_buffer_refresh(struct audio *audio);
137 static void audio_dsp_event(void *private, unsigned id, uint16_t *msg);
139 /* must be called with audio->lock held */
140 static int audio_enable(struct audio *audio)
142 struct audmgr_config cfg;
145 dprintk("audio_enable()\n");
151 audio->out_needed = 0;
153 cfg.tx_rate = RPC_AUD_DEF_SAMPLE_RATE_NONE;
154 cfg.rx_rate = RPC_AUD_DEF_SAMPLE_RATE_48000;
155 cfg.def_method = RPC_AUD_DEF_METHOD_PLAYBACK;
156 cfg.codec = RPC_AUD_DEF_CODEC_AAC;
157 cfg.snd_method = RPC_SND_METHOD_MIDI;
159 rc = audmgr_enable(&audio->audmgr, &cfg);
163 if (msm_adsp_enable(audio->audplay)) {
164 pr_err("audio: msm_adsp_enable(audplay) failed\n");
165 audmgr_disable(&audio->audmgr);
169 if (audpp_enable(audio->dec_id, audio_dsp_event, audio)) {
170 pr_err("audio: audpp_enable() failed\n");
171 msm_adsp_disable(audio->audplay);
172 audmgr_disable(&audio->audmgr);
179 /* must be called with audio->lock held */
180 static int audio_disable(struct audio *audio)
182 dprintk("audio_disable()\n");
183 if (audio->enabled) {
185 auddec_dsp_config(audio, 0);
186 wake_up(&audio->write_wait);
187 wake_up(&audio->read_wait);
188 msm_adsp_disable(audio->audplay);
189 audpp_disable(audio->dec_id, audio);
190 audmgr_disable(&audio->audmgr);
191 audio->out_needed = 0;
196 /* ------------------- dsp --------------------- */
197 static void audio_update_pcm_buf_entry(struct audio *audio, uint32_t *payload)
205 spin_lock_irqsave(&audio->dsp_lock, flags);
206 for (index = 0; index < payload[1]; index++) {
207 if (audio->in[audio->fill_next].addr ==
208 payload[2 + index * 2]) {
209 dprintk("audio_update_pcm_buf_entry: in[%d] ready\n",
211 audio->in[audio->fill_next].used =
212 payload[3 + index * 2];
213 if ((++audio->fill_next) == audio->pcm_buf_count)
214 audio->fill_next = 0;
218 ("audio_update_pcm_buf_entry: expected=%x ret=%x\n"
219 , audio->in[audio->fill_next].addr,
220 payload[1 + index * 2]);
224 if (audio->in[audio->fill_next].used == 0) {
225 audplay_buffer_refresh(audio);
227 dprintk("audio_update_pcm_buf_entry: read cannot keep up\n");
228 audio->buf_refresh = 1;
230 wake_up(&audio->read_wait);
231 spin_unlock_irqrestore(&audio->dsp_lock, flags);
235 static void audplay_dsp_event(void *data, unsigned id, size_t len,
236 void (*getevent) (void *ptr, size_t len))
238 struct audio *audio = data;
240 getevent(msg, sizeof(msg));
242 dprintk("audplay_dsp_event: msg_id=%x\n", id);
245 case AUDPLAY_MSG_DEC_NEEDS_DATA:
246 audplay_send_data(audio, 1);
249 case AUDPLAY_MSG_BUFFER_UPDATE:
250 audio_update_pcm_buf_entry(audio, msg);
254 pr_err("unexpected message from decoder \n");
258 static void audio_dsp_event(void *private, unsigned id, uint16_t *msg)
260 struct audio *audio = private;
263 case AUDPP_MSG_STATUS_MSG:{
264 unsigned status = msg[1];
267 case AUDPP_DEC_STATUS_SLEEP:
268 dprintk("decoder status: sleep \n");
271 case AUDPP_DEC_STATUS_INIT:
272 dprintk("decoder status: init \n");
273 audpp_cmd_cfg_routing_mode(audio);
276 case AUDPP_DEC_STATUS_CFG:
277 dprintk("decoder status: cfg \n");
279 case AUDPP_DEC_STATUS_PLAY:
280 dprintk("decoder status: play \n");
281 if (audio->pcm_feedback) {
282 audplay_config_hostpcm(audio);
283 audplay_buffer_refresh(audio);
287 pr_err("unknown decoder status \n");
291 case AUDPP_MSG_CFG_MSG:
292 if (msg[0] == AUDPP_MSG_ENA_ENA) {
293 dprintk("audio_dsp_event: CFG_MSG ENABLE\n");
294 auddec_dsp_config(audio, 1);
295 audio->out_needed = 0;
297 audpp_set_volume_and_pan(audio->dec_id, audio->volume,
299 audpp_avsync(audio->dec_id, 22050);
300 } else if (msg[0] == AUDPP_MSG_ENA_DIS) {
301 dprintk("audio_dsp_event: CFG_MSG DISABLE\n");
302 audpp_avsync(audio->dec_id, 0);
305 pr_err("audio_dsp_event: CFG_MSG %d?\n", msg[0]);
308 case AUDPP_MSG_ROUTING_ACK:
309 dprintk("audio_dsp_event: ROUTING_ACK mode=%d\n", msg[1]);
310 audpp_cmd_cfg_adec_params(audio);
313 case AUDPP_MSG_FLUSH_ACK:
314 dprintk("%s: FLUSH_ACK\n", __func__);
317 if (audio->pcm_feedback)
318 audplay_buffer_refresh(audio);
322 pr_err("audio_dsp_event: UNKNOWN (%d)\n", id);
327 struct msm_adsp_ops audplay_adsp_ops_aac = {
328 .event = audplay_dsp_event,
331 #define audplay_send_queue0(audio, cmd, len) \
332 msm_adsp_write(audio->audplay, QDSP_uPAudPlay0BitStreamCtrlQueue, \
335 static int auddec_dsp_config(struct audio *audio, int enable)
337 audpp_cmd_cfg_dec_type cmd;
339 memset(&cmd, 0, sizeof(cmd));
340 cmd.cmd_id = AUDPP_CMD_CFG_DEC_TYPE;
342 cmd.dec0_cfg = AUDPP_CMD_UPDATDE_CFG_DEC |
343 AUDPP_CMD_ENA_DEC_V | AUDDEC_DEC_AAC;
345 cmd.dec0_cfg = AUDPP_CMD_UPDATDE_CFG_DEC | AUDPP_CMD_DIS_DEC_V;
347 return audpp_send_queue1(&cmd, sizeof(cmd));
350 static void audpp_cmd_cfg_adec_params(struct audio *audio)
352 audpp_cmd_cfg_adec_params_aac cmd;
354 memset(&cmd, 0, sizeof(cmd));
355 cmd.common.cmd_id = AUDPP_CMD_CFG_ADEC_PARAMS;
356 cmd.common.length = AUDPP_CMD_CFG_ADEC_PARAMS_AAC_LEN;
357 cmd.common.dec_id = audio->dec_id;
358 cmd.common.input_sampling_frequency = audio->out_sample_rate;
359 cmd.format = audio->aac_config.format;
360 cmd.audio_object = audio->aac_config.audio_object;
361 cmd.ep_config = audio->aac_config.ep_config;
362 cmd.aac_section_data_resilience_flag =
363 audio->aac_config.aac_section_data_resilience_flag;
364 cmd.aac_scalefactor_data_resilience_flag =
365 audio->aac_config.aac_scalefactor_data_resilience_flag;
366 cmd.aac_spectral_data_resilience_flag =
367 audio->aac_config.aac_spectral_data_resilience_flag;
368 cmd.sbr_on_flag = audio->aac_config.sbr_on_flag;
369 cmd.sbr_ps_on_flag = audio->aac_config.sbr_ps_on_flag;
370 cmd.channel_configuration = audio->aac_config.channel_configuration;
372 audpp_send_queue2(&cmd, sizeof(cmd));
375 static void audpp_cmd_cfg_routing_mode(struct audio *audio)
377 struct audpp_cmd_routing_mode cmd;
378 dprintk("audpp_cmd_cfg_routing_mode()\n");
379 memset(&cmd, 0, sizeof(cmd));
380 cmd.cmd_id = AUDPP_CMD_ROUTING_MODE;
381 cmd.object_number = audio->dec_id;
382 if (audio->pcm_feedback)
383 cmd.routing_mode = ROUTING_MODE_FTRT;
385 cmd.routing_mode = ROUTING_MODE_RT;
387 audpp_send_queue1(&cmd, sizeof(cmd));
390 static int audplay_dsp_send_data_avail(struct audio *audio,
391 unsigned idx, unsigned len)
393 audplay_cmd_bitstream_data_avail cmd;
395 cmd.cmd_id = AUDPLAY_CMD_BITSTREAM_DATA_AVAIL;
396 cmd.decoder_id = audio->dec_id;
397 cmd.buf_ptr = audio->out[idx].addr;
398 cmd.buf_size = len / 2;
399 cmd.partition_number = 0;
400 return audplay_send_queue0(audio, &cmd, sizeof(cmd));
403 static void audplay_buffer_refresh(struct audio *audio)
405 struct audplay_cmd_buffer_refresh refresh_cmd;
407 refresh_cmd.cmd_id = AUDPLAY_CMD_BUFFER_REFRESH;
408 refresh_cmd.num_buffers = 1;
409 refresh_cmd.buf0_address = audio->in[audio->fill_next].addr;
410 refresh_cmd.buf0_length = audio->in[audio->fill_next].size -
411 (audio->in[audio->fill_next].size % 1024); /* AAC frame size */
412 refresh_cmd.buf_read_count = 0;
413 dprintk("audplay_buffer_fresh: buf0_addr=%x buf0_len=%d\n",
414 refresh_cmd.buf0_address, refresh_cmd.buf0_length);
415 (void)audplay_send_queue0(audio, &refresh_cmd, sizeof(refresh_cmd));
418 static void audplay_config_hostpcm(struct audio *audio)
420 struct audplay_cmd_hpcm_buf_cfg cfg_cmd;
422 dprintk("audplay_config_hostpcm()\n");
423 cfg_cmd.cmd_id = AUDPLAY_CMD_HPCM_BUF_CFG;
424 cfg_cmd.max_buffers = audio->pcm_buf_count;
425 cfg_cmd.byte_swap = 0;
426 cfg_cmd.hostpcm_config = (0x8000) | (0x4000);
427 cfg_cmd.feedback_frequency = 1;
428 cfg_cmd.partition_number = 0;
429 (void)audplay_send_queue0(audio, &cfg_cmd, sizeof(cfg_cmd));
433 static void audplay_send_data(struct audio *audio, unsigned needed)
435 struct buffer *frame;
438 spin_lock_irqsave(&audio->dsp_lock, flags);
442 if (needed && !audio->wflush) {
443 /* We were called from the callback because the DSP
444 * requested more data. Note that the DSP does want
445 * more data, and if a buffer was in-flight, mark it
446 * as available (since the DSP must now be done with
449 audio->out_needed = 1;
450 frame = audio->out + audio->out_tail;
451 if (frame->used == 0xffffffff) {
452 dprintk("frame %d free\n", audio->out_tail);
454 audio->out_tail ^= 1;
455 wake_up(&audio->write_wait);
459 if (audio->out_needed) {
460 /* If the DSP currently wants data and we have a
461 * buffer available, we will send it and reset
462 * the needed flag. We'll mark the buffer as in-flight
463 * so that it won't be recycled until the next buffer
467 frame = audio->out + audio->out_tail;
469 BUG_ON(frame->used == 0xffffffff);
470 /* printk("frame %d busy\n", audio->out_tail); */
471 audplay_dsp_send_data_avail(audio, audio->out_tail,
473 frame->used = 0xffffffff;
474 audio->out_needed = 0;
478 spin_unlock_irqrestore(&audio->dsp_lock, flags);
481 /* ------------------- device --------------------- */
483 static void audio_flush(struct audio *audio)
485 audio->out[0].used = 0;
486 audio->out[1].used = 0;
490 audio->out_needed = 0;
491 atomic_set(&audio->out_bytes, 0);
494 static void audio_flush_pcm_buf(struct audio *audio)
498 for (index = 0; index < PCM_BUF_MAX_COUNT; index++)
499 audio->in[index].used = 0;
500 audio->buf_refresh = 0;
501 audio->read_next = 0;
502 audio->fill_next = 0;
505 static int audaac_validate_usr_config(struct msm_audio_aac_config *config)
509 if (config->format != AUDIO_AAC_FORMAT_ADTS &&
510 config->format != AUDIO_AAC_FORMAT_RAW &&
511 config->format != AUDIO_AAC_FORMAT_PSUEDO_RAW &&
512 config->format != AUDIO_AAC_FORMAT_LOAS)
515 if (config->audio_object != AUDIO_AAC_OBJECT_LC &&
516 config->audio_object != AUDIO_AAC_OBJECT_LTP &&
517 config->audio_object != AUDIO_AAC_OBJECT_ERLC)
520 if (config->audio_object == AUDIO_AAC_OBJECT_ERLC) {
521 if (config->ep_config > 3)
523 if (config->aac_scalefactor_data_resilience_flag !=
524 AUDIO_AAC_SCA_DATA_RES_OFF &&
525 config->aac_scalefactor_data_resilience_flag !=
526 AUDIO_AAC_SCA_DATA_RES_ON)
528 if (config->aac_section_data_resilience_flag !=
529 AUDIO_AAC_SEC_DATA_RES_OFF &&
530 config->aac_section_data_resilience_flag !=
531 AUDIO_AAC_SEC_DATA_RES_ON)
533 if (config->aac_spectral_data_resilience_flag !=
534 AUDIO_AAC_SPEC_DATA_RES_OFF &&
535 config->aac_spectral_data_resilience_flag !=
536 AUDIO_AAC_SPEC_DATA_RES_ON)
539 config->aac_section_data_resilience_flag =
540 AUDIO_AAC_SEC_DATA_RES_OFF;
541 config->aac_scalefactor_data_resilience_flag =
542 AUDIO_AAC_SCA_DATA_RES_OFF;
543 config->aac_spectral_data_resilience_flag =
544 AUDIO_AAC_SPEC_DATA_RES_OFF;
547 if (config->sbr_on_flag != AUDIO_AAC_SBR_ON_FLAG_OFF &&
548 config->sbr_on_flag != AUDIO_AAC_SBR_ON_FLAG_ON)
551 if (config->sbr_ps_on_flag != AUDIO_AAC_SBR_PS_ON_FLAG_OFF &&
552 config->sbr_ps_on_flag != AUDIO_AAC_SBR_PS_ON_FLAG_ON)
555 if (config->dual_mono_mode > AUDIO_AAC_DUAL_MONO_PL_SR)
558 if (config->channel_configuration > 2)
566 static void audio_ioport_reset(struct audio *audio)
568 /* Make sure read/write thread are free from
569 * sleep and knowing that system is not able
570 * to process io request at the moment
572 wake_up(&audio->write_wait);
573 mutex_lock(&audio->write_lock);
575 mutex_unlock(&audio->write_lock);
576 wake_up(&audio->read_wait);
577 mutex_lock(&audio->read_lock);
578 audio_flush_pcm_buf(audio);
579 mutex_unlock(&audio->read_lock);
582 static long audio_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
584 struct audio *audio = file->private_data;
587 dprintk("audio_ioctl() cmd = %d\n", cmd);
589 if (cmd == AUDIO_GET_STATS) {
590 struct msm_audio_stats stats;
591 stats.byte_count = audpp_avsync_byte_count(audio->dec_id);
592 stats.sample_count = audpp_avsync_sample_count(audio->dec_id);
593 if (copy_to_user((void *)arg, &stats, sizeof(stats)))
597 if (cmd == AUDIO_SET_VOLUME) {
599 spin_lock_irqsave(&audio->dsp_lock, flags);
602 audpp_set_volume_and_pan(audio->dec_id, arg, 0);
603 spin_unlock_irqrestore(&audio->dsp_lock, flags);
606 mutex_lock(&audio->lock);
609 rc = audio_enable(audio);
612 rc = audio_disable(audio);
614 audio_ioport_reset(audio);
618 dprintk("%s: AUDIO_FLUSH\n", __func__);
621 audio_ioport_reset(audio);
623 audpp_flush(audio->dec_id);
630 case AUDIO_SET_CONFIG:{
631 struct msm_audio_config config;
634 (&config, (void *)arg, sizeof(config))) {
639 if (config.channel_count == 1) {
640 config.channel_count =
641 AUDPP_CMD_PCM_INTF_MONO_V;
642 } else if (config.channel_count == 2) {
643 config.channel_count =
644 AUDPP_CMD_PCM_INTF_STEREO_V;
650 audio->out_sample_rate = config.sample_rate;
651 audio->out_channel_mode = config.channel_count;
655 case AUDIO_GET_CONFIG:{
656 struct msm_audio_config config;
657 config.buffer_size = BUFSZ;
658 config.buffer_count = 2;
659 config.sample_rate = audio->out_sample_rate;
660 if (audio->out_channel_mode ==
661 AUDPP_CMD_PCM_INTF_MONO_V) {
662 config.channel_count = 1;
664 config.channel_count = 2;
666 config.unused[0] = 0;
667 config.unused[1] = 0;
668 config.unused[2] = 0;
669 config.unused[3] = 0;
670 if (copy_to_user((void *)arg, &config,
678 case AUDIO_GET_AAC_CONFIG:{
679 if (copy_to_user((void *)arg, &audio->aac_config,
680 sizeof(audio->aac_config)))
686 case AUDIO_SET_AAC_CONFIG:{
687 struct msm_audio_aac_config usr_config;
690 (&usr_config, (void *)arg,
691 sizeof(usr_config))) {
696 if (audaac_validate_usr_config(&usr_config) == 0) {
697 audio->aac_config = usr_config;
704 case AUDIO_GET_PCM_CONFIG:{
705 struct msm_audio_pcm_config config;
706 config.pcm_feedback = 0;
707 config.buffer_count = PCM_BUF_MAX_COUNT;
708 config.buffer_size = PCM_BUFSZ_MIN;
709 if (copy_to_user((void *)arg, &config,
716 case AUDIO_SET_PCM_CONFIG:{
717 struct msm_audio_pcm_config config;
719 (&config, (void *)arg, sizeof(config))) {
723 if ((config.buffer_count > PCM_BUF_MAX_COUNT) ||
724 (config.buffer_count == 1))
725 config.buffer_count = PCM_BUF_MAX_COUNT;
727 if (config.buffer_size < PCM_BUFSZ_MIN)
728 config.buffer_size = PCM_BUFSZ_MIN;
730 /* Check if pcm feedback is required */
731 if ((config.pcm_feedback) && (!audio->read_data)) {
732 dprintk("ioctl: allocate PCM buffer %d\n",
733 config.buffer_count *
736 dma_alloc_coherent(NULL,
741 if (!audio->read_data) {
742 pr_err("audio_aac: buf alloc fail\n");
747 audio->pcm_feedback = 1;
748 audio->buf_refresh = 0;
749 audio->pcm_buf_count =
751 audio->read_next = 0;
752 audio->fill_next = 0;
755 index < config.buffer_count;
757 audio->in[index].data =
758 audio->read_data + offset;
759 audio->in[index].addr =
760 audio->read_phys + offset;
761 audio->in[index].size =
763 audio->in[index].used = 0;
764 offset += config.buffer_size;
774 dprintk("%s: AUDIO_PAUSE %ld\n", __func__, arg);
775 rc = audpp_pause(audio->dec_id, (int) arg);
780 mutex_unlock(&audio->lock);
784 static ssize_t audio_read(struct file *file, char __user *buf, size_t count,
787 struct audio *audio = file->private_data;
788 const char __user *start = buf;
791 if (!audio->pcm_feedback)
792 return 0; /* PCM feedback is not enabled. Nothing to read */
794 mutex_lock(&audio->read_lock);
795 dprintk("audio_read() %d \n", count);
797 rc = wait_event_interruptible(audio->read_wait,
798 (audio->in[audio->read_next].
799 used > 0) || (audio->stopped)
805 if (audio->stopped || audio->rflush) {
810 if (count < audio->in[audio->read_next].used) {
811 /* Read must happen in frame boundary. Since driver
812 does not know frame size, read count must be greater
813 or equal to size of PCM samples */
814 dprintk("audio_read: no partial frame done reading\n");
817 dprintk("audio_read: read from in[%d]\n",
820 (buf, audio->in[audio->read_next].data,
821 audio->in[audio->read_next].used)) {
822 pr_err("audio_read: invalid addr %x \n",
827 count -= audio->in[audio->read_next].used;
828 buf += audio->in[audio->read_next].used;
829 audio->in[audio->read_next].used = 0;
830 if ((++audio->read_next) == audio->pcm_buf_count)
831 audio->read_next = 0;
832 if (audio->in[audio->read_next].used == 0)
833 break; /* No data ready at this moment
834 * Exit while loop to prevent
835 * output thread sleep too long
840 /* don't feed output buffer to HW decoder during flushing
841 * buffer refresh command will be sent once flush completes
842 * send buf refresh command here can confuse HW decoder
844 if (audio->buf_refresh && !audio->rflush) {
845 audio->buf_refresh = 0;
846 dprintk("audio_read: kick start pcm feedback again\n");
847 audplay_buffer_refresh(audio);
850 mutex_unlock(&audio->read_lock);
855 dprintk("audio_read: read %d bytes\n", rc);
859 static ssize_t audio_write(struct file *file, const char __user *buf,
860 size_t count, loff_t *pos)
862 struct audio *audio = file->private_data;
863 const char __user *start = buf;
864 struct buffer *frame;
870 mutex_lock(&audio->write_lock);
872 frame = audio->out + audio->out_head;
873 cpy_ptr = frame->data;
875 rc = wait_event_interruptible(audio->write_wait,
881 if (audio->stopped || audio->wflush) {
886 if (audio->reserved) {
887 dprintk("%s: append reserved byte %x\n",
888 __func__, audio->rsv_byte);
889 *cpy_ptr = audio->rsv_byte;
890 xfer = (count > (frame->size - 1)) ?
891 frame->size - 1 : count;
896 xfer = (count > frame->size) ? frame->size : count;
898 if (copy_from_user(cpy_ptr, buf, xfer)) {
905 audio->rsv_byte = ((char *) frame->data)[dsize - 1];
906 dprintk("%s: odd length buf reserve last byte %x\n",
907 __func__, audio->rsv_byte);
915 audio->out_head ^= 1;
917 audplay_send_data(audio, 0);
920 mutex_unlock(&audio->write_lock);
926 static int audio_release(struct inode *inode, struct file *file)
928 struct audio *audio = file->private_data;
930 dprintk("audio_release()\n");
932 mutex_lock(&audio->lock);
933 audio_disable(audio);
935 audio_flush_pcm_buf(audio);
936 msm_adsp_put(audio->audplay);
937 audio->audplay = NULL;
940 dma_free_coherent(NULL, DMASZ, audio->data, audio->phys);
942 if (audio->read_data != NULL) {
943 dma_free_coherent(NULL,
944 audio->in[0].size * audio->pcm_buf_count,
945 audio->read_data, audio->read_phys);
946 audio->read_data = NULL;
948 audio->pcm_feedback = 0;
949 mutex_unlock(&audio->lock);
953 static struct audio the_aac_audio;
955 static int audio_open(struct inode *inode, struct file *file)
957 struct audio *audio = &the_aac_audio;
960 mutex_lock(&audio->lock);
963 pr_err("audio: busy\n");
969 audio->data = dma_alloc_coherent(NULL, DMASZ,
970 &audio->phys, GFP_KERNEL);
972 pr_err("audio: could not allocate DMA buffers\n");
978 rc = audmgr_open(&audio->audmgr);
982 rc = msm_adsp_get("AUDPLAY0TASK", &audio->audplay,
983 &audplay_adsp_ops_aac, audio);
985 pr_err("audio: failed to get audplay0 dsp module\n");
988 audio->out_sample_rate = 44100;
989 audio->out_channel_mode = AUDPP_CMD_PCM_INTF_STEREO_V;
990 audio->aac_config.format = AUDIO_AAC_FORMAT_ADTS;
991 audio->aac_config.audio_object = AUDIO_AAC_OBJECT_LC;
992 audio->aac_config.ep_config = 0;
993 audio->aac_config.aac_section_data_resilience_flag =
994 AUDIO_AAC_SEC_DATA_RES_OFF;
995 audio->aac_config.aac_scalefactor_data_resilience_flag =
996 AUDIO_AAC_SCA_DATA_RES_OFF;
997 audio->aac_config.aac_spectral_data_resilience_flag =
998 AUDIO_AAC_SPEC_DATA_RES_OFF;
999 audio->aac_config.sbr_on_flag = AUDIO_AAC_SBR_ON_FLAG_ON;
1000 audio->aac_config.sbr_ps_on_flag = AUDIO_AAC_SBR_PS_ON_FLAG_ON;
1001 audio->aac_config.dual_mono_mode = AUDIO_AAC_DUAL_MONO_PL_SR;
1002 audio->aac_config.channel_configuration = 2;
1005 audio->out[0].data = audio->data + 0;
1006 audio->out[0].addr = audio->phys + 0;
1007 audio->out[0].size = BUFSZ;
1009 audio->out[1].data = audio->data + BUFSZ;
1010 audio->out[1].addr = audio->phys + BUFSZ;
1011 audio->out[1].size = BUFSZ;
1013 audio->volume = 0x2000; /* Q13 1.0 */
1017 file->private_data = audio;
1021 mutex_unlock(&audio->lock);
1025 static struct file_operations audio_aac_fops = {
1026 .owner = THIS_MODULE,
1028 .release = audio_release,
1030 .write = audio_write,
1031 .unlocked_ioctl = audio_ioctl,
1034 struct miscdevice audio_aac_misc = {
1035 .minor = MISC_DYNAMIC_MINOR,
1037 .fops = &audio_aac_fops,
1040 static int __init audio_init(void)
1042 mutex_init(&the_aac_audio.lock);
1043 mutex_init(&the_aac_audio.write_lock);
1044 mutex_init(&the_aac_audio.read_lock);
1045 spin_lock_init(&the_aac_audio.dsp_lock);
1046 init_waitqueue_head(&the_aac_audio.write_wait);
1047 init_waitqueue_head(&the_aac_audio.read_wait);
1048 the_aac_audio.read_data = NULL;
1049 return misc_register(&audio_aac_misc);
1052 device_initcall(audio_init);