/**
* sst_drain_stream - Send msg for draining stream
* @str_id: stream ID
*
* This function is called by any function which wants to drain
* a stream.
*/
int sst_drain_stream(int str_id, bool partial_drain)
{
int retval = 0, pvt_id, len;
struct ipc_post *msg = NULL;
struct stream_info *str_info;
struct intel_sst_ops *ops;
unsigned long irq_flags;
struct sst_block *block = NULL;
struct ipc_dsp_hdr dsp_hdr;
pr_debug("SST DBG:sst_drain_stream for %d\n", str_id);
str_info = get_stream_info(str_id);
if (!str_info)
return -EINVAL;
ops = sst_drv_ctx->ops;
if (str_info->status != STREAM_RUNNING &&
str_info->status != STREAM_INIT &&
str_info->status != STREAM_PAUSED) {
pr_err("SST ERR: BADQRC for stream = %d\n",
str_info->status);
return -EBADRQC;
}
if (!sst_drv_ctx->use_32bit_ops) {
pvt_id = sst_assign_pvt_id(sst_drv_ctx);
retval = sst_create_block_and_ipc_msg(&msg, true,
sst_drv_ctx, &block, IPC_CMD, pvt_id);
if (retval)
return retval;
sst_fill_header_mrfld(&msg->mrfld_header, IPC_CMD,
str_info->task_id, 1, pvt_id);
pr_debug("header:%x\n",
(unsigned int)msg->mrfld_header.p.header_high.full);
msg->mrfld_header.p.header_high.part.res_rqd = 1;
len = sizeof(u8) + sizeof(dsp_hdr);
msg->mrfld_header.p.header_low_payload = len;
sst_fill_header_dsp(&dsp_hdr, IPC_IA_DRAIN_STREAM_MRFLD,
str_info->pipe_id, sizeof(u8));
memcpy(msg->mailbox_data, &dsp_hdr, sizeof(dsp_hdr));
memcpy(msg->mailbox_data + sizeof(dsp_hdr),
&partial_drain, sizeof(u8));
} else {
retval = sst_create_block_and_ipc_msg(&msg, false,
sst_drv_ctx, &block,
IPC_IA_DRAIN_STREAM, str_id);
if (retval)
return retval;
sst_fill_header(&msg->header, IPC_IA_DRAIN_STREAM, 0, str_id);
msg->header.part.data = partial_drain;
}
spin_lock_irqsave(&sst_drv_ctx->ipc_spin_lock, irq_flags);
list_add_tail(&msg->node, &sst_drv_ctx->ipc_dispatch_list);
spin_unlock_irqrestore(&sst_drv_ctx->ipc_spin_lock, irq_flags);
ops->post_message(&sst_drv_ctx->ipc_post_msg_wq);
retval = sst_wait_interruptible(sst_drv_ctx, block);
sst_free_block(sst_drv_ctx, block);
return retval;
}
/**
* sst_drop_stream - Send msg for stopping stream
* @str_id: stream ID
*
* This function is called by any function which wants to stop
* a stream.
*/
int sst_drop_stream(int str_id)
{
int retval = 0, pvt_id;
struct stream_info *str_info;
struct ipc_post *msg = NULL;
struct ipc_dsp_hdr dsp_hdr;
pr_debug("SST DBG:sst_drop_stream for %d\n", str_id);
str_info = get_stream_info(str_id);
if (!str_info)
return -EINVAL;
if (str_info->status != STREAM_UN_INIT) {
if ((sst_drv_ctx->pci_id != SST_MRFLD_PCI_ID) ||
(sst_drv_ctx->use_32bit_ops == true)) {
str_info->prev = STREAM_UN_INIT;
str_info->status = STREAM_INIT;
str_info->cumm_bytes = 0;
sst_send_sync_msg(IPC_IA_DROP_STREAM, str_id);
} else {
if (sst_create_ipc_msg(&msg, true))
return -ENOMEM;
str_info->prev = STREAM_UN_INIT;
str_info->status = STREAM_INIT;
str_info->cumm_bytes = 0;
pvt_id = sst_assign_pvt_id(sst_drv_ctx);
sst_fill_header_mrfld(&msg->mrfld_header, IPC_CMD,
str_info->task_id, 1, pvt_id);
msg->mrfld_header.p.header_low_payload = sizeof(dsp_hdr);
sst_fill_header_dsp(&dsp_hdr, IPC_IA_DROP_STREAM_MRFLD,
str_info->pipe_id, 0);
memcpy(msg->mailbox_data, &dsp_hdr, sizeof(dsp_hdr));
sst_drv_ctx->ops->sync_post_message(msg);
}
} else {
retval = -EBADRQC;
pr_debug("BADQRC for stream, state %x\n", str_info->status);
}
return retval;
}
/**
* sst_stream_stream - Send msg for a pausing stream
* @str_id: stream ID
*
* This function is called by any function which wants to start
* a stream.
*/
int sst_start_stream(int str_id)
{
int retval = 0, pvt_id;
u32 len = 0;
struct ipc_post *msg = NULL;
struct ipc_dsp_hdr dsp_hdr;
struct stream_info *str_info;
pr_debug("sst_start_stream for %d\n", str_id);
str_info = get_stream_info(str_id);
if (!str_info)
return -EINVAL;
if (str_info->status != STREAM_RUNNING)
return -EBADRQC;
if (sst_create_ipc_msg(&msg, true))
return -ENOMEM;
if (!sst_drv_ctx->use_32bit_ops) {
pr_debug("start mrfld");
pvt_id = sst_assign_pvt_id(sst_drv_ctx);
pr_debug("pvt_id = %d, pipe id = %d, task = %d\n",
pvt_id, str_info->pipe_id, str_info->task_id);
sst_fill_header_mrfld(&msg->mrfld_header, IPC_CMD,
str_info->task_id, 1, pvt_id);
len = sizeof(u16) + sizeof(dsp_hdr);
msg->mrfld_header.p.header_low_payload = len;
sst_fill_header_dsp(&dsp_hdr, IPC_IA_START_STREAM_MRFLD,
str_info->pipe_id, sizeof(u16));
memcpy(msg->mailbox_data, &dsp_hdr, sizeof(dsp_hdr));
memset(msg->mailbox_data + sizeof(dsp_hdr), 0, sizeof(u16));
} else {
pr_debug("fill START_STREAM for MFLD/CTP\n");
sst_fill_header(&msg->header, IPC_IA_START_STREAM, 1, str_id);
msg->header.part.data = sizeof(u32) + sizeof(u32);
memcpy(msg->mailbox_data, &msg->header, sizeof(u32));
memset(msg->mailbox_data + sizeof(u32), 0, sizeof(u32));
}
sst_drv_ctx->ops->sync_post_message(msg);
return retval;
}
int sst_format_vtsv_message(struct intel_sst_drv *ctx,
struct ipc_post **msgptr, struct sst_block **block)
{
int retval = 0, pvt_id, len;
struct ipc_dsp_hdr dsp_hdr;
struct snd_sst_vtsv_info vinfo;
struct ipc_post *msg;
vinfo.vfiles[0].addr = (u32)ctx->vcache.file1_in_mem;
vinfo.vfiles[0].size = ctx->vcache.size1;
vinfo.vfiles[1].addr = (u32)ctx->vcache.file2_in_mem;
vinfo.vfiles[1].size = ctx->vcache.size2;
/* Create the vtsv message */
pvt_id = sst_assign_pvt_id(ctx);
retval = sst_create_block_and_ipc_msg(msgptr, true,
ctx, block, IPC_CMD, pvt_id);
if (retval)
return retval;
msg = *msgptr;
sst_fill_header_mrfld(&msg->mrfld_header, IPC_CMD,
SST_TASK_ID_AWARE, 1, pvt_id);
pr_debug("header:%x\n",
(unsigned int)msg->mrfld_header.p.header_high.full);
msg->mrfld_header.p.header_high.part.res_rqd = 1;
len = sizeof(vinfo) + sizeof(dsp_hdr);
msg->mrfld_header.p.header_low_payload = len;
sst_fill_header_dsp(&dsp_hdr, IPC_IA_VTSV_UPDATE_MODULES,
PIPE_VAD_OUT, sizeof(u8));
dsp_hdr.mod_id = SST_ALGO_VTSV;
memcpy(msg->mailbox_data, &dsp_hdr, sizeof(dsp_hdr));
memcpy(msg->mailbox_data + sizeof(dsp_hdr),
&vinfo, sizeof(vinfo));
return 0;
}
int sst_alloc_stream_mrfld(char *params, struct sst_block *block)
{
struct ipc_post *msg = NULL;
struct snd_sst_alloc_mrfld alloc_param;
struct ipc_dsp_hdr dsp_hdr;
struct snd_sst_params *str_params;
struct snd_sst_tstamp fw_tstamp;
int str_id, pipe_id, pvt_id;
u32 len = 0;
struct stream_info *str_info;
unsigned long irq_flags;
pr_debug("In %s\n", __func__);
BUG_ON(!params);
str_params = (struct snd_sst_params *)params;
memset(&alloc_param, 0, sizeof(alloc_param));
alloc_param.operation = str_params->ops;
alloc_param.codec_type = str_params->codec;
alloc_param.sg_count = str_params->aparams.sg_count;
alloc_param.ring_buf_info[0].addr = str_params->aparams.ring_buf_info[0].addr;
alloc_param.ring_buf_info[0].size = str_params->aparams.ring_buf_info[0].size;
alloc_param.frag_size = str_params->aparams.frag_size;
alloc_param.codec_params.uc.pcm_params.num_ch = str_params->sparams.uc.pcm_params.num_chan;
alloc_param.codec_params.uc.pcm_params.pcm_wd_sz = str_params->sparams.uc.pcm_params.pcm_wd_sz;
alloc_param.codec_params.uc.pcm_params.path = 0;
alloc_param.codec_params.uc.pcm_params.rsvd = 0;
alloc_param.codec_params.uc.pcm_params.sfreq = str_params->sparams.uc.pcm_params.sfreq;
alloc_param.codec_params.uc.pcm_params.chan_map[0] = 0;
alloc_param.codec_params.uc.pcm_params.chan_map[1] = 1;
pr_debug("period_size = %d\n", alloc_param.frag_size);
pr_debug("ring_buf_addr = 0x%x\n", alloc_param.ring_buf_info[0].addr);
pr_debug("ring_buf_size = %d\n", alloc_param.ring_buf_info[0].size);
pr_debug("In alloc sg_count =%d\n", alloc_param.sg_count);
str_id = str_params->stream_id;
pipe_id = str_params->device_type;
sst_drv_ctx->streams[str_id].pipe_id = pipe_id;
pvt_id = sst_assign_pvt_id(sst_drv_ctx);
alloc_param.ts = (sst_drv_ctx->mailbox_add +
sst_drv_ctx->tstamp + (str_id * sizeof(fw_tstamp)));
pr_debug("alloc tstamp location = 0x%p\n", alloc_param.ts);
pr_debug("assigned pipe id 0x%x\n", pipe_id);
/*allocate device type context*/
sst_init_stream(&sst_drv_ctx->streams[str_id], alloc_param.codec_type,
str_id, alloc_param.operation, 0);
/* send msg to FW to allocate a stream */
if (sst_create_ipc_msg(&msg, true))
return -ENOMEM;
#ifndef MRFLD_TEST_ON_MFLD
block->drv_id = pvt_id;
block->msg_id = IPC_CMD;
sst_fill_header_mrfld(&msg->mrfld_header, IPC_CMD,
IPC_QUE_ID_MED, 1, pvt_id);
pr_debug("header:%x\n", msg->mrfld_header.p.header_high);
msg->mrfld_header.p.header_high.part.res_rqd = 1;
len = msg->mrfld_header.p.header_low_payload = sizeof(alloc_param) + sizeof(dsp_hdr);
sst_fill_header_dsp(&dsp_hdr, IPC_IA_ALLOC_STREAM_MRFLD, pipe_id, sizeof(alloc_param));
memcpy(msg->mailbox_data, &dsp_hdr, sizeof(dsp_hdr));
memcpy(msg->mailbox_data + sizeof(dsp_hdr), &alloc_param,
sizeof(alloc_param));
#else
block->drv_id = pvt_id;
block->msg_id = IPC_IA_ALLOC_STREAM;
sst_fill_header_mrfld_32(&msg->header.full, IPC_QUE_ID_MED,
IPC_CMD, pvt_id, 1, 1);
len = sizeof(alloc_param) + sizeof(dsp_hdr);
sst_fill_header_dsp(&dsp_hdr, IPC_IA_ALLOC_STREAM_MRFLD, pipe_id, sizeof(alloc_param));
memcpy(msg->mailbox_data, &len, sizeof(len));
memcpy(msg->mailbox_data + sizeof(len), &dsp_hdr, sizeof(dsp_hdr));
memcpy(msg->mailbox_data + sizeof(dsp_hdr) + sizeof(len), &alloc_param,
sizeof(alloc_param));
#endif
str_info = &sst_drv_ctx->streams[str_id];
pr_debug("header:%x\n", msg->mrfld_header.p.header_high);
pr_debug("response rqd: %x", msg->mrfld_header.p.header_high.part.res_rqd);
spin_lock_irqsave(&sst_drv_ctx->ipc_spin_lock, irq_flags);
list_add_tail(&msg->node, &sst_drv_ctx->ipc_dispatch_list);
spin_unlock_irqrestore(&sst_drv_ctx->ipc_spin_lock, irq_flags);
pr_debug("calling post_message\n");
sst_drv_ctx->ops->post_message(&sst_drv_ctx->ipc_post_msg_wq);
return str_id;
}
/**
* sst_free_stream - Frees a stream
* @str_id: stream ID
*
* This function is called by any function which wants to free
* a stream.
*/
int sst_free_stream(int str_id)
{
int retval = 0;
unsigned int pvt_id;
struct ipc_post *msg = NULL;
struct stream_info *str_info;
struct intel_sst_ops *ops;
unsigned long irq_flags;
struct ipc_dsp_hdr dsp_hdr;
struct sst_block *block;
pr_debug("SST DBG:sst_free_stream for %d\n", str_id);
mutex_lock(&sst_drv_ctx->sst_lock);
if (sst_drv_ctx->sst_state == SST_UN_INIT) {
mutex_unlock(&sst_drv_ctx->sst_lock);
return -ENODEV;
}
mutex_unlock(&sst_drv_ctx->sst_lock);
str_info = get_stream_info(str_id);
if (!str_info)
return -EINVAL;
ops = sst_drv_ctx->ops;
mutex_lock(&str_info->lock);
if (str_info->status != STREAM_UN_INIT) {
str_info->prev = str_info->status;
str_info->status = STREAM_UN_INIT;
mutex_unlock(&str_info->lock);
if (!sst_drv_ctx->use_32bit_ops) {
pvt_id = sst_assign_pvt_id(sst_drv_ctx);
retval = sst_create_block_and_ipc_msg(&msg, true,
sst_drv_ctx, &block, IPC_CMD, pvt_id);
if (retval)
return retval;
sst_fill_header_mrfld(&msg->mrfld_header, IPC_CMD,
str_info->task_id, 1, pvt_id);
msg->mrfld_header.p.header_low_payload =
sizeof(dsp_hdr);
sst_fill_header_dsp(&dsp_hdr, IPC_IA_FREE_STREAM_MRFLD,
str_info->pipe_id, 0);
memcpy(msg->mailbox_data, &dsp_hdr, sizeof(dsp_hdr));
} else {
retval = sst_create_block_and_ipc_msg(&msg, false,
sst_drv_ctx, &block,
IPC_IA_FREE_STREAM, str_id);
if (retval)
return retval;
sst_fill_header(&msg->header, IPC_IA_FREE_STREAM,
0, str_id);
}
spin_lock_irqsave(&sst_drv_ctx->ipc_spin_lock, irq_flags);
list_add_tail(&msg->node, &sst_drv_ctx->ipc_dispatch_list);
spin_unlock_irqrestore(&sst_drv_ctx->ipc_spin_lock, irq_flags);
if (!sst_drv_ctx->use_32bit_ops) {
/*FIXME: do we need to wake up drain stream here,
* how to get the pvt_id and msg_id
*/
} else {
sst_wake_up_block(sst_drv_ctx, 0, str_id,
IPC_IA_DRAIN_STREAM, NULL, 0);
}
ops->post_message(&sst_drv_ctx->ipc_post_msg_wq);
retval = sst_wait_timeout(sst_drv_ctx, block);
pr_debug("sst: wait for free returned %d\n", retval);
mutex_lock(&sst_drv_ctx->stream_lock);
sst_clean_stream(str_info);
mutex_unlock(&sst_drv_ctx->stream_lock);
pr_debug("SST DBG:Stream freed\n");
sst_free_block(sst_drv_ctx, block);
} else {
mutex_unlock(&str_info->lock);
retval = -EBADRQC;
pr_debug("SST DBG:BADQRC for stream\n");
}
return retval;
}
/**
* sst_resume_stream - Send msg for resuming stream
* @str_id: stream ID
*
* This function is called by any function which wants to resume
* an already paused stream.
*/
int sst_resume_stream(int str_id)
{
int retval = 0;
struct ipc_post *msg = NULL;
struct stream_info *str_info;
struct intel_sst_ops *ops;
unsigned long irq_flags;
struct sst_block *block = NULL;
int pvt_id, len;
struct ipc_dsp_hdr dsp_hdr;
pr_debug("SST DBG:sst_resume_stream for %d\n", str_id);
str_info = get_stream_info(str_id);
if (!str_info)
return -EINVAL;
ops = sst_drv_ctx->ops;
if (str_info->status == STREAM_RUNNING)
return 0;
if (str_info->status == STREAM_PAUSED) {
if (!sst_drv_ctx->use_32bit_ops) {
pvt_id = sst_assign_pvt_id(sst_drv_ctx);
retval = sst_create_block_and_ipc_msg(&msg, true,
sst_drv_ctx, &block, IPC_CMD, pvt_id);
if (retval)
return retval;
sst_fill_header_mrfld(&msg->mrfld_header, IPC_CMD,
str_info->task_id, 1, pvt_id);
msg->mrfld_header.p.header_high.part.res_rqd = 1;
len = sizeof(dsp_hdr);
msg->mrfld_header.p.header_low_payload = len;
sst_fill_header_dsp(&dsp_hdr,
IPC_IA_RESUME_STREAM_MRFLD,
str_info->pipe_id, 0);
memcpy(msg->mailbox_data, &dsp_hdr, sizeof(dsp_hdr));
} else {
retval = sst_create_block_and_ipc_msg(&msg, false,
sst_drv_ctx, &block,
IPC_IA_RESUME_STREAM, str_id);
if (retval)
return retval;
sst_fill_header(&msg->header, IPC_IA_RESUME_STREAM,
0, str_id);
}
spin_lock_irqsave(&sst_drv_ctx->ipc_spin_lock, irq_flags);
list_add_tail(&msg->node,
&sst_drv_ctx->ipc_dispatch_list);
spin_unlock_irqrestore(&sst_drv_ctx->ipc_spin_lock, irq_flags);
ops->post_message(&sst_drv_ctx->ipc_post_msg_wq);
retval = sst_wait_timeout(sst_drv_ctx, block);
sst_free_block(sst_drv_ctx, block);
if (!retval) {
if (str_info->prev == STREAM_RUNNING)
str_info->status = STREAM_RUNNING;
else
str_info->status = STREAM_INIT;
str_info->prev = STREAM_PAUSED;
} else if (retval == -SST_ERR_INVALID_STREAM_ID) {
retval = -EINVAL;
mutex_lock(&sst_drv_ctx->stream_lock);
sst_clean_stream(str_info);
mutex_unlock(&sst_drv_ctx->stream_lock);
}
} else {
retval = -EBADRQC;
pr_err("SST ERR: BADQRC for stream\n");
}
return retval;
}
int sst_alloc_stream_mrfld(char *params, struct sst_block *block)
{
struct ipc_post *msg = NULL;
struct snd_sst_alloc_mrfld alloc_param;
struct ipc_dsp_hdr dsp_hdr;
struct snd_sst_params *str_params;
struct snd_sst_tstamp fw_tstamp;
unsigned int str_id, pipe_id, pvt_id, task_id;
u32 len = 0;
struct stream_info *str_info;
unsigned long irq_flags;
int i, num_ch;
pr_debug("In %s\n", __func__);
BUG_ON(!params);
str_params = (struct snd_sst_params *)params;
memset(&alloc_param, 0, sizeof(alloc_param));
alloc_param.operation = str_params->ops;
alloc_param.codec_type = str_params->codec;
alloc_param.sg_count = str_params->aparams.sg_count;
alloc_param.ring_buf_info[0].addr = str_params->aparams.ring_buf_info[0].addr;
alloc_param.ring_buf_info[0].size = str_params->aparams.ring_buf_info[0].size;
alloc_param.frag_size = str_params->aparams.frag_size;
memcpy(&alloc_param.codec_params, &str_params->sparams,
sizeof(struct snd_sst_stream_params));
/* fill channel map params for multichannel support.
* Ideally channel map should be received from upper layers
* for multichannel support.
* Currently hardcoding as per FW reqm.
*/
num_ch = sst_get_num_channel(str_params);
for (i = 0; i < 8; i++) {
if (i < num_ch)
alloc_param.codec_params.uc.pcm_params.channel_map[i] = i;
else
alloc_param.codec_params.uc.pcm_params.channel_map[i] = 0xFF;
}
str_id = str_params->stream_id;
pipe_id = str_params->device_type;
task_id = str_params->task;
sst_drv_ctx->streams[str_id].pipe_id = pipe_id;
sst_drv_ctx->streams[str_id].task_id = task_id;
sst_drv_ctx->streams[str_id].num_ch = num_ch;
pvt_id = sst_assign_pvt_id(sst_drv_ctx);
alloc_param.ts = (struct snd_sst_tstamp *) (sst_drv_ctx->mailbox_add +
sst_drv_ctx->tstamp + (str_id * sizeof(fw_tstamp)));
pr_debug("alloc tstamp location = 0x%p\n", alloc_param.ts);
pr_debug("assigned pipe id 0x%x to task %d\n", pipe_id, task_id);
/*allocate device type context*/
sst_init_stream(&sst_drv_ctx->streams[str_id], alloc_param.codec_type,
str_id, alloc_param.operation, 0);
/* send msg to FW to allocate a stream */
if (sst_create_ipc_msg(&msg, true))
return -ENOMEM;
block->drv_id = pvt_id;
block->msg_id = IPC_CMD;
sst_fill_header_mrfld(&msg->mrfld_header, IPC_CMD,
task_id, 1, pvt_id);
pr_debug("header:%x\n", msg->mrfld_header.p.header_high.full);
msg->mrfld_header.p.header_high.part.res_rqd = 1;
len = msg->mrfld_header.p.header_low_payload = sizeof(alloc_param) + sizeof(dsp_hdr);
sst_fill_header_dsp(&dsp_hdr, IPC_IA_ALLOC_STREAM_MRFLD, pipe_id, sizeof(alloc_param));
memcpy(msg->mailbox_data, &dsp_hdr, sizeof(dsp_hdr));
memcpy(msg->mailbox_data + sizeof(dsp_hdr), &alloc_param,
sizeof(alloc_param));
str_info = &sst_drv_ctx->streams[str_id];
pr_debug("header:%x\n", msg->mrfld_header.p.header_high.full);
pr_debug("response rqd: %x", msg->mrfld_header.p.header_high.part.res_rqd);
spin_lock_irqsave(&sst_drv_ctx->ipc_spin_lock, irq_flags);
list_add_tail(&msg->node, &sst_drv_ctx->ipc_dispatch_list);
spin_unlock_irqrestore(&sst_drv_ctx->ipc_spin_lock, irq_flags);
pr_debug("calling post_message\n");
sst_drv_ctx->ops->post_message(&sst_drv_ctx->ipc_post_msg_wq);
return str_id;
}