223 lines
7.1 KiB
C
223 lines
7.1 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2012-2013 The Linux Foundation. All rights reserved.
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or modify
|
||
|
|
* it under the terms of the GNU General Public License version 2 and
|
||
|
|
* only version 2 as published by the Free Software Foundation.
|
||
|
|
*
|
||
|
|
* 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/module.h>
|
||
|
|
#include <linux/fs.h>
|
||
|
|
#include <linux/miscdevice.h>
|
||
|
|
#include <linux/uaccess.h>
|
||
|
|
#include <linux/sched.h>
|
||
|
|
#include <linux/wait.h>
|
||
|
|
#include <linux/dma-mapping.h>
|
||
|
|
#include <linux/slab.h>
|
||
|
|
#include <linux/atomic.h>
|
||
|
|
#include <asm/ioctls.h>
|
||
|
|
#include "audio_utils_aio.h"
|
||
|
|
|
||
|
|
void q6_audio_cb(uint32_t opcode, uint32_t token,
|
||
|
|
uint32_t *payload, void *priv)
|
||
|
|
{
|
||
|
|
struct q6audio_aio *audio = (struct q6audio_aio *)priv;
|
||
|
|
|
||
|
|
pr_debug("%s:opcode = %x token = 0x%x\n", __func__, opcode, token);
|
||
|
|
switch (opcode) {
|
||
|
|
case ASM_DATA_EVENT_WRITE_DONE:
|
||
|
|
case ASM_DATA_EVENT_READ_DONE:
|
||
|
|
case ASM_DATA_CMDRSP_EOS:
|
||
|
|
case ASM_DATA_CMD_MEDIA_FORMAT_UPDATE:
|
||
|
|
case ASM_STREAM_CMD_SET_ENCDEC_PARAM:
|
||
|
|
case ASM_DATA_EVENT_SR_CM_CHANGE_NOTIFY:
|
||
|
|
case ASM_DATA_EVENT_ENC_SR_CM_NOTIFY:
|
||
|
|
audio_aio_cb(opcode, token, payload, audio);
|
||
|
|
break;
|
||
|
|
case APR_BASIC_RSP_RESULT:
|
||
|
|
audio_aio_cb(opcode, token, payload, audio);
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
pr_debug("%s:Unhandled event = 0x%8x\n", __func__, opcode);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void audio_aio_cb(uint32_t opcode, uint32_t token,
|
||
|
|
uint32_t *payload, void *priv)
|
||
|
|
{
|
||
|
|
union msm_audio_event_payload e_payload;
|
||
|
|
struct q6audio_aio *audio = (struct q6audio_aio *)priv;
|
||
|
|
|
||
|
|
switch (opcode) {
|
||
|
|
case ASM_DATA_EVENT_WRITE_DONE:
|
||
|
|
pr_debug("%s[%p]:ASM_DATA_EVENT_WRITE_DONE token = 0x%x\n",
|
||
|
|
__func__, audio, token);
|
||
|
|
audio_aio_async_write_ack(audio, token, payload);
|
||
|
|
break;
|
||
|
|
case ASM_DATA_EVENT_READ_DONE:
|
||
|
|
pr_debug("%s[%p]:ASM_DATA_EVENT_READ_DONE token = 0x%x\n",
|
||
|
|
__func__, audio, token);
|
||
|
|
audio_aio_async_read_ack(audio, token, payload);
|
||
|
|
break;
|
||
|
|
case ASM_DATA_CMDRSP_EOS:
|
||
|
|
/* EOS Handle */
|
||
|
|
pr_debug("%s[%p]:ASM_DATA_CMDRSP_EOS\n", __func__, audio);
|
||
|
|
if (audio->feedback) { /* Non-Tunnel mode */
|
||
|
|
audio->eos_rsp = 1;
|
||
|
|
/* propagate input EOS i/p buffer,
|
||
|
|
after receiving DSP acknowledgement */
|
||
|
|
if (audio->eos_flag &&
|
||
|
|
(audio->eos_write_payload.aio_buf.buf_addr)) {
|
||
|
|
audio_aio_post_event(audio,
|
||
|
|
AUDIO_EVENT_WRITE_DONE,
|
||
|
|
audio->eos_write_payload);
|
||
|
|
memset(&audio->eos_write_payload , 0,
|
||
|
|
sizeof(union msm_audio_event_payload));
|
||
|
|
audio->eos_flag = 0;
|
||
|
|
}
|
||
|
|
} else { /* Tunnel mode */
|
||
|
|
audio->eos_rsp = 1;
|
||
|
|
wake_up(&audio->write_wait);
|
||
|
|
wake_up(&audio->cmd_wait);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
case ASM_DATA_CMD_MEDIA_FORMAT_UPDATE:
|
||
|
|
case ASM_STREAM_CMD_SET_ENCDEC_PARAM:
|
||
|
|
pr_debug("%s[%p]:payload0[%x] payloa1d[%x]opcode= 0x%x\n",
|
||
|
|
__func__, audio, payload[0], payload[1], opcode);
|
||
|
|
break;
|
||
|
|
case ASM_DATA_EVENT_SR_CM_CHANGE_NOTIFY:
|
||
|
|
case ASM_DATA_EVENT_ENC_SR_CM_NOTIFY:
|
||
|
|
pr_debug("%s[%p]: ASM_DATA_EVENT_SR_CM_CHANGE_NOTIFY, "
|
||
|
|
|
||
|
|
"payload[0]-sr = %d, payload[1]-chl = %d, "
|
||
|
|
"payload[2] = %d, payload[3] = %d\n", __func__,
|
||
|
|
audio, payload[0], payload[1], payload[2],
|
||
|
|
payload[3]);
|
||
|
|
pr_debug("%s[%p]: ASM_DATA_EVENT_SR_CM_CHANGE_NOTIFY, sr(prev) = %d, chl(prev) = %d,",
|
||
|
|
__func__, audio, audio->pcm_cfg.sample_rate,
|
||
|
|
audio->pcm_cfg.channel_count);
|
||
|
|
audio->pcm_cfg.sample_rate = payload[0];
|
||
|
|
audio->pcm_cfg.channel_count = payload[1] & 0xFFFF;
|
||
|
|
e_payload.stream_info.chan_info = audio->pcm_cfg.channel_count;
|
||
|
|
e_payload.stream_info.sample_rate = audio->pcm_cfg.sample_rate;
|
||
|
|
audio_aio_post_event(audio, AUDIO_EVENT_STREAM_INFO, e_payload);
|
||
|
|
break;
|
||
|
|
case APR_BASIC_RSP_RESULT:
|
||
|
|
switch (payload[0]) {
|
||
|
|
case ASM_STREAM_CMD_FLUSH:
|
||
|
|
if (payload[1] == ADSP_EOK) {
|
||
|
|
pr_debug("%s: FLUSH CMD success\n", __func__);
|
||
|
|
audio_aio_ioport_reset(audio);
|
||
|
|
audio->wflush = 0;
|
||
|
|
audio->rflush = 0;
|
||
|
|
} else {
|
||
|
|
pr_err("%s: FLUSH CMD failed with status:%d\n",
|
||
|
|
__func__, payload[1]);
|
||
|
|
audio_aio_ioport_reset(audio);
|
||
|
|
audio->wflush = 0;
|
||
|
|
audio->rflush = 0;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
pr_debug("%s: cmd%x cmd_status:%d\n",
|
||
|
|
__func__, payload[0], payload[1]);
|
||
|
|
}
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void extract_meta_out_info(struct q6audio_aio *audio,
|
||
|
|
struct audio_aio_buffer_node *buf_node, int dir)
|
||
|
|
{
|
||
|
|
struct dec_meta_out *meta_data = buf_node->kvaddr;
|
||
|
|
if (dir) { /* input buffer - Write */
|
||
|
|
if (audio->buf_cfg.meta_info_enable)
|
||
|
|
memcpy(&buf_node->meta_info.meta_in,
|
||
|
|
(char *)buf_node->kvaddr, sizeof(struct dec_meta_in));
|
||
|
|
else
|
||
|
|
memset(&buf_node->meta_info.meta_in,
|
||
|
|
0, sizeof(struct dec_meta_in));
|
||
|
|
pr_debug("%s[%p]:i/p: msw_ts 0x%lx lsw_ts 0x%lx nflags 0x%8x\n",
|
||
|
|
__func__, audio,
|
||
|
|
buf_node->meta_info.meta_in.ntimestamp.highpart,
|
||
|
|
buf_node->meta_info.meta_in.ntimestamp.lowpart,
|
||
|
|
buf_node->meta_info.meta_in.nflags);
|
||
|
|
} else { /* output buffer - Read */
|
||
|
|
memcpy((char *)buf_node->kvaddr,
|
||
|
|
&buf_node->meta_info.meta_out,
|
||
|
|
sizeof(struct dec_meta_out));
|
||
|
|
meta_data->meta_out_dsp[0].nflags = 0x00000000;
|
||
|
|
pr_debug("%s[%p]:o/p: msw_ts 0x%8x lsw_ts 0x%8x nflags 0x%8x, num_frames = %d\n",
|
||
|
|
__func__, audio,
|
||
|
|
((struct dec_meta_out *)buf_node->kvaddr)->\
|
||
|
|
meta_out_dsp[0].msw_ts,
|
||
|
|
((struct dec_meta_out *)buf_node->kvaddr)->\
|
||
|
|
meta_out_dsp[0].lsw_ts,
|
||
|
|
((struct dec_meta_out *)buf_node->kvaddr)->\
|
||
|
|
meta_out_dsp[0].nflags,
|
||
|
|
((struct dec_meta_out *)buf_node->kvaddr)->num_of_frames);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Read buffer from DSP / Handle Ack from DSP */
|
||
|
|
void audio_aio_async_read_ack(struct q6audio_aio *audio, uint32_t token,
|
||
|
|
uint32_t *payload)
|
||
|
|
{
|
||
|
|
unsigned long flags;
|
||
|
|
union msm_audio_event_payload event_payload;
|
||
|
|
struct audio_aio_buffer_node *filled_buf;
|
||
|
|
|
||
|
|
/* No active flush in progress */
|
||
|
|
if (audio->rflush)
|
||
|
|
return;
|
||
|
|
|
||
|
|
/* Statistics of read */
|
||
|
|
atomic_add(payload[2], &audio->in_bytes);
|
||
|
|
atomic_add(payload[7], &audio->in_samples);
|
||
|
|
|
||
|
|
spin_lock_irqsave(&audio->dsp_lock, flags);
|
||
|
|
BUG_ON(list_empty(&audio->in_queue));
|
||
|
|
filled_buf = list_first_entry(&audio->in_queue,
|
||
|
|
struct audio_aio_buffer_node, list);
|
||
|
|
if (token == (filled_buf->token)) {
|
||
|
|
list_del(&filled_buf->list);
|
||
|
|
spin_unlock_irqrestore(&audio->dsp_lock, flags);
|
||
|
|
event_payload.aio_buf = filled_buf->buf;
|
||
|
|
/* Read done Buffer due to flush/normal condition
|
||
|
|
after EOS event, so append EOS buffer */
|
||
|
|
if (audio->eos_rsp == 0x1) {
|
||
|
|
event_payload.aio_buf.data_len =
|
||
|
|
insert_eos_buf(audio, filled_buf);
|
||
|
|
/* Reset flag back to indicate eos intimated */
|
||
|
|
audio->eos_rsp = 0;
|
||
|
|
} else {
|
||
|
|
filled_buf->meta_info.meta_out.num_of_frames =
|
||
|
|
payload[7];
|
||
|
|
event_payload.aio_buf.data_len = payload[2] + \
|
||
|
|
payload[3] + \
|
||
|
|
sizeof(struct dec_meta_out);
|
||
|
|
pr_debug("%s[%p]:nr of frames 0x%8x len=%d\n",
|
||
|
|
__func__, audio,
|
||
|
|
filled_buf->meta_info.meta_out.num_of_frames,
|
||
|
|
event_payload.aio_buf.data_len);
|
||
|
|
extract_meta_out_info(audio, filled_buf, 0);
|
||
|
|
audio->eos_rsp = 0;
|
||
|
|
}
|
||
|
|
audio_aio_post_event(audio, AUDIO_EVENT_READ_DONE,
|
||
|
|
event_payload);
|
||
|
|
kfree(filled_buf);
|
||
|
|
} else {
|
||
|
|
pr_err("%s[%p]:expected=%lx ret=%x\n",
|
||
|
|
__func__, audio, filled_buf->token, token);
|
||
|
|
spin_unlock_irqrestore(&audio->dsp_lock, flags);
|
||
|
|
}
|
||
|
|
}
|