sound/soc/intel/atom/sst/sst_stream.c - kernel/msm-4.19 - Gitiles

 /*
  *  sst_stream.c - Intel SST Driver for audio engine
  *
  *  Copyright (C) 2008-14 Intel Corp
  *  Authors:	Vinod Koul <vinod.koul@intel.com>
  *		Harsha Priya <priya.harsha@intel.com>
  *		Dharageswari R <dharageswari.r@intel.com>
  *		KP Jeeja <jeeja.kp@intel.com>
  *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  *
  *  This program is free software; you can redistribute it and/or modify
  *  it under the terms of the GNU General Public License as published by
  *  the Free Software Foundation; version 2 of the License.
  *
  *  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/pci.h>
 #include <linux/firmware.h>
 #include <linux/sched.h>
 #include <linux/delay.h>
 #include <linux/pm_runtime.h>
 #include <sound/core.h>
 #include <sound/pcm.h>
 #include <sound/soc.h>
 #include <sound/compress_driver.h>
 #include <asm/platform_sst_audio.h>
 #include "../sst-mfld-platform.h"
 #include "sst.h"
 #include "../../common/sst-dsp.h"

 int sst_alloc_stream_mrfld(struct intel_sst_drv *sst_drv_ctx, void *params)
 {
 	struct snd_sst_alloc_mrfld alloc_param;
 	struct snd_sst_params *str_params;
 	struct snd_sst_tstamp fw_tstamp;
 	struct stream_info *str_info;
 	struct snd_sst_alloc_response *response;
 	unsigned int str_id, pipe_id, task_id;
 	int i, num_ch, ret = 0;
 	void *data = NULL;

 	dev_dbg(sst_drv_ctx->dev, "Enter\n");
 	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;
 	str_info = get_stream_info(sst_drv_ctx, str_id);
 	if (str_info == NULL) {
 		dev_err(sst_drv_ctx->dev, "get stream info returned null\n");
 		return -EINVAL;
 	}

 	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;

 	if (sst_drv_ctx->info.lpe_viewpt_rqd)
 		alloc_param.ts = sst_drv_ctx->info.mailbox_start +
 			sst_drv_ctx->tstamp + (str_id * sizeof(fw_tstamp));
 	else
 		alloc_param.ts = sst_drv_ctx->mailbox_add +
 			sst_drv_ctx->tstamp + (str_id * sizeof(fw_tstamp));

 	dev_dbg(sst_drv_ctx->dev, "alloc tstamp location = 0x%x\n",
 			alloc_param.ts);
 	dev_dbg(sst_drv_ctx->dev, "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);

 	dev_info(sst_drv_ctx->dev, "Alloc for str %d pipe %#x\n",
 			str_id, pipe_id);
 	ret = sst_prepare_and_post_msg(sst_drv_ctx, task_id, IPC_CMD,
 			IPC_IA_ALLOC_STREAM_MRFLD, pipe_id, sizeof(alloc_param),
 			&alloc_param, &data, true, true, false, true);

 	if (ret < 0) {
 		dev_err(sst_drv_ctx->dev, "FW alloc failed ret %d\n", ret);
 		/* alloc failed, so reset the state to uninit */
 		str_info->status = STREAM_UN_INIT;
 		str_id = ret;
 	} else if (data) {
 		response = (struct snd_sst_alloc_response *)data;
 		ret = response->str_type.result;
 		if (!ret)
 			goto out;
 		dev_err(sst_drv_ctx->dev, "FW alloc failed ret %d\n", ret);
 		if (ret == SST_ERR_STREAM_IN_USE) {
 			dev_err(sst_drv_ctx->dev,
 				"FW not in clean state, send free for:%d\n", str_id);
 			sst_free_stream(sst_drv_ctx, str_id);
 		}
 		str_id = -ret;
 	}
 out:
 	kfree(data);
 	return str_id;
 }

 /**
 * sst_start_stream - Send msg for a starting stream
 * @str_id:	 stream ID
 *
 * This function is called by any function which wants to start
 * a stream.
 */
 int sst_start_stream(struct intel_sst_drv *sst_drv_ctx, int str_id)
 {
 	int retval = 0;
 	struct stream_info *str_info;
 	u16 data = 0;

 	dev_dbg(sst_drv_ctx->dev, "sst_start_stream for %d\n", str_id);
 	str_info = get_stream_info(sst_drv_ctx, str_id);
 	if (!str_info)
 		return -EINVAL;
 	if (str_info->status != STREAM_RUNNING)
 		return -EBADRQC;

 	retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id,
 			IPC_CMD, IPC_IA_START_STREAM_MRFLD, str_info->pipe_id,
 			sizeof(u16), &data, NULL, true, true, true, false);

 	return retval;
 }

 int sst_send_byte_stream_mrfld(struct intel_sst_drv *sst_drv_ctx,
 		struct snd_sst_bytes_v2 *bytes)
 {	struct ipc_post *msg = NULL;
 	u32 length;
 	int pvt_id, ret = 0;
 	struct sst_block *block = NULL;

 	dev_dbg(sst_drv_ctx->dev,
 		"type:%u ipc_msg:%u block:%u task_id:%u pipe: %#x length:%#x\n",
 		bytes->type, bytes->ipc_msg, bytes->block, bytes->task_id,
 		bytes->pipe_id, bytes->len);

 	if (sst_create_ipc_msg(&msg, true))
 		return -ENOMEM;

 	pvt_id = sst_assign_pvt_id(sst_drv_ctx);
 	sst_fill_header_mrfld(&msg->mrfld_header, bytes->ipc_msg,
 			bytes->task_id, 1, pvt_id);
 	msg->mrfld_header.p.header_high.part.res_rqd = bytes->block;
 	length = bytes->len;
 	msg->mrfld_header.p.header_low_payload = length;
 	dev_dbg(sst_drv_ctx->dev, "length is %d\n", length);
 	memcpy(msg->mailbox_data, &bytes->bytes, bytes->len);
 	if (bytes->block) {
 		block = sst_create_block(sst_drv_ctx, bytes->ipc_msg, pvt_id);
 		if (block == NULL) {
 			kfree(msg);
 			ret = -ENOMEM;
 			goto out;
 		}
 	}

 	sst_add_to_dispatch_list_and_post(sst_drv_ctx, msg);
 	dev_dbg(sst_drv_ctx->dev, "msg->mrfld_header.p.header_low_payload:%d",
 			msg->mrfld_header.p.header_low_payload);

 	if (bytes->block) {
 		ret = sst_wait_timeout(sst_drv_ctx, block);
 		if (ret) {
 			dev_err(sst_drv_ctx->dev, "fw returned err %d\n", ret);
 			sst_free_block(sst_drv_ctx, block);
 			goto out;
 		}
 	}
 	if (bytes->type == SND_SST_BYTES_GET) {
 		/*
 		 * copy the reply and send back
 		 * we need to update only sz and payload
 		 */
 		if (bytes->block) {
 			unsigned char *r = block->data;

 			dev_dbg(sst_drv_ctx->dev, "read back %d bytes",
 					bytes->len);
 			memcpy(bytes->bytes, r, bytes->len);
 		}
 	}
 	if (bytes->block)
 		sst_free_block(sst_drv_ctx, block);
 out:
 	test_and_clear_bit(pvt_id, &sst_drv_ctx->pvt_id);
 	return 0;
 }

 /*
  * sst_pause_stream - Send msg for a pausing stream
  * @str_id:	 stream ID
  *
  * This function is called by any function which wants to pause
  * an already running stream.
  */
 int sst_pause_stream(struct intel_sst_drv *sst_drv_ctx, int str_id)
 {
 	int retval = 0;
 	struct stream_info *str_info;

 	dev_dbg(sst_drv_ctx->dev, "SST DBG:sst_pause_stream for %d\n", str_id);
 	str_info = get_stream_info(sst_drv_ctx, str_id);
 	if (!str_info)
 		return -EINVAL;
 	if (str_info->status == STREAM_PAUSED)
 		return 0;
 	if (str_info->status == STREAM_RUNNING ||
 		str_info->status == STREAM_INIT) {
 		if (str_info->prev == STREAM_UN_INIT)
 			return -EBADRQC;

 		retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id, IPC_CMD,
 				IPC_IA_PAUSE_STREAM_MRFLD, str_info->pipe_id,
 				0, NULL, NULL, true, true, false, true);

 		if (retval == 0) {
 			str_info->prev = str_info->status;
 			str_info->status = STREAM_PAUSED;
 		} else if (retval == SST_ERR_INVALID_STREAM_ID) {
 			retval = -EINVAL;
 			mutex_lock(&sst_drv_ctx->sst_lock);
 			sst_clean_stream(str_info);
 			mutex_unlock(&sst_drv_ctx->sst_lock);
 		}
 	} else {
 		retval = -EBADRQC;
 		dev_dbg(sst_drv_ctx->dev, "SST DBG:BADRQC 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(struct intel_sst_drv *sst_drv_ctx, int str_id)
 {
 	int retval = 0;
 	struct stream_info *str_info;

 	dev_dbg(sst_drv_ctx->dev, "SST DBG:sst_resume_stream for %d\n", str_id);
 	str_info = get_stream_info(sst_drv_ctx, str_id);
 	if (!str_info)
 		return -EINVAL;
 	if (str_info->status == STREAM_RUNNING)
 			return 0;
 	if (str_info->status == STREAM_PAUSED) {
 		retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id,
 				IPC_CMD, IPC_IA_RESUME_STREAM_MRFLD,
 				str_info->pipe_id, 0, NULL, NULL,
 				true, true, false, true);

 		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->sst_lock);
 			sst_clean_stream(str_info);
 			mutex_unlock(&sst_drv_ctx->sst_lock);
 		}
 	} else {
 		retval = -EBADRQC;
 		dev_err(sst_drv_ctx->dev, "SST ERR: BADQRC for stream\n");
 	}

 	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(struct intel_sst_drv *sst_drv_ctx, int str_id)
 {
 	int retval = 0;
 	struct stream_info *str_info;

 	dev_dbg(sst_drv_ctx->dev, "SST DBG:sst_drop_stream for %d\n", str_id);
 	str_info = get_stream_info(sst_drv_ctx, str_id);
 	if (!str_info)
 		return -EINVAL;

 	if (str_info->status != STREAM_UN_INIT) {
 		str_info->prev = STREAM_UN_INIT;
 		str_info->status = STREAM_INIT;
 		str_info->cumm_bytes = 0;
 		retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id,
 				IPC_CMD, IPC_IA_DROP_STREAM_MRFLD,
 				str_info->pipe_id, 0, NULL, NULL,
 				true, true, true, false);
 	} else {
 		retval = -EBADRQC;
 		dev_dbg(sst_drv_ctx->dev, "BADQRC for stream, state %x\n",
 				str_info->status);
 	}
 	return retval;
 }

 /**
 * 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(struct intel_sst_drv *sst_drv_ctx,
 			int str_id, bool partial_drain)
 {
 	int retval = 0;
 	struct stream_info *str_info;

 	dev_dbg(sst_drv_ctx->dev, "SST DBG:sst_drain_stream for %d\n", str_id);
 	str_info = get_stream_info(sst_drv_ctx, str_id);
 	if (!str_info)
 		return -EINVAL;
 	if (str_info->status != STREAM_RUNNING &&
 		str_info->status != STREAM_INIT &&
 		str_info->status != STREAM_PAUSED) {
 			dev_err(sst_drv_ctx->dev, "SST ERR: BADQRC for stream = %d\n",
 				       str_info->status);
 			return -EBADRQC;
 	}

 	retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id, IPC_CMD,
 			IPC_IA_DRAIN_STREAM_MRFLD, str_info->pipe_id,
 			sizeof(u8), &partial_drain, NULL, true, true, false, false);
 	/*
 	 * with new non blocked drain implementation in core we dont need to
 	 * wait for respsonse, and need to only invoke callback for drain
 	 * complete
 	 */

 	return retval;
 }

 /**
  * 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(struct intel_sst_drv *sst_drv_ctx, int str_id)
 {
 	int retval = 0;
 	struct stream_info *str_info;
 	struct intel_sst_ops *ops;

 	dev_dbg(sst_drv_ctx->dev, "SST DBG:sst_free_stream for %d\n", str_id);

 	mutex_lock(&sst_drv_ctx->sst_lock);
 	if (sst_drv_ctx->sst_state == SST_RESET) {
 		mutex_unlock(&sst_drv_ctx->sst_lock);
 		return -ENODEV;
 	}
 	mutex_unlock(&sst_drv_ctx->sst_lock);
 	str_info = get_stream_info(sst_drv_ctx, 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);

 		dev_info(sst_drv_ctx->dev, "Free for str %d pipe %#x\n",
 				str_id, str_info->pipe_id);
 		retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id, IPC_CMD,
 				IPC_IA_FREE_STREAM_MRFLD, str_info->pipe_id, 0,
 				NULL, NULL, true, true, false, true);

 		dev_dbg(sst_drv_ctx->dev, "sst: wait for free returned %d\n",
 				retval);
 		mutex_lock(&sst_drv_ctx->sst_lock);
 		sst_clean_stream(str_info);
 		mutex_unlock(&sst_drv_ctx->sst_lock);
 		dev_dbg(sst_drv_ctx->dev, "SST DBG:Stream freed\n");
 	} else {
 		mutex_unlock(&str_info->lock);
 		retval = -EBADRQC;
 		dev_dbg(sst_drv_ctx->dev, "SST DBG:BADQRC for stream\n");
 	}

 	return retval;
 }
	/*
	* sst_stream.c - Intel SST Driver for audio engine
	*
	* Copyright (C) 2008-14 Intel Corp
	* Authors: Vinod Koul <vinod.koul@intel.com>
	* Harsha Priya <priya.harsha@intel.com>
	* Dharageswari R <dharageswari.r@intel.com>
	* KP Jeeja <jeeja.kp@intel.com>
	* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
	*
	* This program is free software; you can redistribute it and/or modify
	* it under the terms of the GNU General Public License as published by
	* the Free Software Foundation; version 2 of the License.
	*
	* 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/pci.h>
	#include <linux/firmware.h>
	#include <linux/sched.h>
	#include <linux/delay.h>
	#include <linux/pm_runtime.h>
	#include <sound/core.h>
	#include <sound/pcm.h>
	#include <sound/soc.h>
	#include <sound/compress_driver.h>
	#include <asm/platform_sst_audio.h>
	#include "../sst-mfld-platform.h"
	#include "sst.h"
	#include "../../common/sst-dsp.h"

	int sst_alloc_stream_mrfld(struct intel_sst_drv sst_drv_ctx, void params)
	{
	struct snd_sst_alloc_mrfld alloc_param;
	struct snd_sst_params *str_params;
	struct snd_sst_tstamp fw_tstamp;
	struct stream_info *str_info;
	struct snd_sst_alloc_response *response;
	unsigned int str_id, pipe_id, task_id;
	int i, num_ch, ret = 0;
	void *data = NULL;

	dev_dbg(sst_drv_ctx->dev, "Enter\n");
	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;
	str_info = get_stream_info(sst_drv_ctx, str_id);
	if (str_info == NULL) {
	dev_err(sst_drv_ctx->dev, "get stream info returned null\n");
	return -EINVAL;
	}

	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;

	if (sst_drv_ctx->info.lpe_viewpt_rqd)
	alloc_param.ts = sst_drv_ctx->info.mailbox_start +
	sst_drv_ctx->tstamp + (str_id * sizeof(fw_tstamp));
	else
	alloc_param.ts = sst_drv_ctx->mailbox_add +
	sst_drv_ctx->tstamp + (str_id * sizeof(fw_tstamp));

	dev_dbg(sst_drv_ctx->dev, "alloc tstamp location = 0x%x\n",
	alloc_param.ts);
	dev_dbg(sst_drv_ctx->dev, "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);

	dev_info(sst_drv_ctx->dev, "Alloc for str %d pipe %#x\n",
	str_id, pipe_id);
	ret = sst_prepare_and_post_msg(sst_drv_ctx, task_id, IPC_CMD,
	IPC_IA_ALLOC_STREAM_MRFLD, pipe_id, sizeof(alloc_param),
	&alloc_param, &data, true, true, false, true);

	if (ret < 0) {
	dev_err(sst_drv_ctx->dev, "FW alloc failed ret %d\n", ret);
	/* alloc failed, so reset the state to uninit */
	str_info->status = STREAM_UN_INIT;
	str_id = ret;
	} else if (data) {
	response = (struct snd_sst_alloc_response *)data;
	ret = response->str_type.result;
	if (!ret)
	goto out;
	dev_err(sst_drv_ctx->dev, "FW alloc failed ret %d\n", ret);
	if (ret == SST_ERR_STREAM_IN_USE) {
	dev_err(sst_drv_ctx->dev,
	"FW not in clean state, send free for:%d\n", str_id);
	sst_free_stream(sst_drv_ctx, str_id);
	}
	str_id = -ret;
	}
	out:
	kfree(data);
	return str_id;
	}

	/**
	* sst_start_stream - Send msg for a starting stream
	* @str_id: stream ID
	*
	* This function is called by any function which wants to start
	* a stream.
	*/
	int sst_start_stream(struct intel_sst_drv *sst_drv_ctx, int str_id)
	{
	int retval = 0;
	struct stream_info *str_info;
	u16 data = 0;

	dev_dbg(sst_drv_ctx->dev, "sst_start_stream for %d\n", str_id);
	str_info = get_stream_info(sst_drv_ctx, str_id);
	if (!str_info)
	return -EINVAL;
	if (str_info->status != STREAM_RUNNING)
	return -EBADRQC;

	retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id,
	IPC_CMD, IPC_IA_START_STREAM_MRFLD, str_info->pipe_id,
	sizeof(u16), &data, NULL, true, true, true, false);

	return retval;
	}

	int sst_send_byte_stream_mrfld(struct intel_sst_drv *sst_drv_ctx,
	struct snd_sst_bytes_v2 *bytes)
	{ struct ipc_post *msg = NULL;
	u32 length;
	int pvt_id, ret = 0;
	struct sst_block *block = NULL;

	dev_dbg(sst_drv_ctx->dev,
	"type:%u ipc_msg:%u block:%u task_id:%u pipe: %#x length:%#x\n",
	bytes->type, bytes->ipc_msg, bytes->block, bytes->task_id,
	bytes->pipe_id, bytes->len);

	if (sst_create_ipc_msg(&msg, true))
	return -ENOMEM;

	pvt_id = sst_assign_pvt_id(sst_drv_ctx);
	sst_fill_header_mrfld(&msg->mrfld_header, bytes->ipc_msg,
	bytes->task_id, 1, pvt_id);
	msg->mrfld_header.p.header_high.part.res_rqd = bytes->block;
	length = bytes->len;
	msg->mrfld_header.p.header_low_payload = length;
	dev_dbg(sst_drv_ctx->dev, "length is %d\n", length);
	memcpy(msg->mailbox_data, &bytes->bytes, bytes->len);
	if (bytes->block) {
	block = sst_create_block(sst_drv_ctx, bytes->ipc_msg, pvt_id);
	if (block == NULL) {
	kfree(msg);
	ret = -ENOMEM;
	goto out;
	}
	}

	sst_add_to_dispatch_list_and_post(sst_drv_ctx, msg);
	dev_dbg(sst_drv_ctx->dev, "msg->mrfld_header.p.header_low_payload:%d",
	msg->mrfld_header.p.header_low_payload);

	if (bytes->block) {
	ret = sst_wait_timeout(sst_drv_ctx, block);
	if (ret) {
	dev_err(sst_drv_ctx->dev, "fw returned err %d\n", ret);
	sst_free_block(sst_drv_ctx, block);
	goto out;
	}
	}
	if (bytes->type == SND_SST_BYTES_GET) {
	/*
	* copy the reply and send back
	* we need to update only sz and payload
	*/
	if (bytes->block) {
	unsigned char *r = block->data;

	dev_dbg(sst_drv_ctx->dev, "read back %d bytes",
	bytes->len);
	memcpy(bytes->bytes, r, bytes->len);
	}
	}
	if (bytes->block)
	sst_free_block(sst_drv_ctx, block);
	out:
	test_and_clear_bit(pvt_id, &sst_drv_ctx->pvt_id);
	return 0;
	}

	/*
	* sst_pause_stream - Send msg for a pausing stream
	* @str_id: stream ID
	*
	* This function is called by any function which wants to pause
	* an already running stream.
	*/
	int sst_pause_stream(struct intel_sst_drv *sst_drv_ctx, int str_id)
	{
	int retval = 0;
	struct stream_info *str_info;

	dev_dbg(sst_drv_ctx->dev, "SST DBG:sst_pause_stream for %d\n", str_id);
	str_info = get_stream_info(sst_drv_ctx, str_id);
	if (!str_info)
	return -EINVAL;
	if (str_info->status == STREAM_PAUSED)
	return 0;
	if (str_info->status == STREAM_RUNNING \|\|
	str_info->status == STREAM_INIT) {
	if (str_info->prev == STREAM_UN_INIT)
	return -EBADRQC;

	retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id, IPC_CMD,
	IPC_IA_PAUSE_STREAM_MRFLD, str_info->pipe_id,
	0, NULL, NULL, true, true, false, true);

	if (retval == 0) {
	str_info->prev = str_info->status;
	str_info->status = STREAM_PAUSED;
	} else if (retval == SST_ERR_INVALID_STREAM_ID) {
	retval = -EINVAL;
	mutex_lock(&sst_drv_ctx->sst_lock);
	sst_clean_stream(str_info);
	mutex_unlock(&sst_drv_ctx->sst_lock);
	}
	} else {
	retval = -EBADRQC;
	dev_dbg(sst_drv_ctx->dev, "SST DBG:BADRQC 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(struct intel_sst_drv *sst_drv_ctx, int str_id)
	{
	int retval = 0;
	struct stream_info *str_info;

	dev_dbg(sst_drv_ctx->dev, "SST DBG:sst_resume_stream for %d\n", str_id);
	str_info = get_stream_info(sst_drv_ctx, str_id);
	if (!str_info)
	return -EINVAL;
	if (str_info->status == STREAM_RUNNING)
	return 0;
	if (str_info->status == STREAM_PAUSED) {
	retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id,
	IPC_CMD, IPC_IA_RESUME_STREAM_MRFLD,
	str_info->pipe_id, 0, NULL, NULL,
	true, true, false, true);

	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->sst_lock);
	sst_clean_stream(str_info);
	mutex_unlock(&sst_drv_ctx->sst_lock);
	}
	} else {
	retval = -EBADRQC;
	dev_err(sst_drv_ctx->dev, "SST ERR: BADQRC for stream\n");
	}

	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(struct intel_sst_drv *sst_drv_ctx, int str_id)
	{
	int retval = 0;
	struct stream_info *str_info;

	dev_dbg(sst_drv_ctx->dev, "SST DBG:sst_drop_stream for %d\n", str_id);
	str_info = get_stream_info(sst_drv_ctx, str_id);
	if (!str_info)
	return -EINVAL;

	if (str_info->status != STREAM_UN_INIT) {
	str_info->prev = STREAM_UN_INIT;
	str_info->status = STREAM_INIT;
	str_info->cumm_bytes = 0;
	retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id,
	IPC_CMD, IPC_IA_DROP_STREAM_MRFLD,
	str_info->pipe_id, 0, NULL, NULL,
	true, true, true, false);
	} else {
	retval = -EBADRQC;
	dev_dbg(sst_drv_ctx->dev, "BADQRC for stream, state %x\n",
	str_info->status);
	}
	return retval;
	}

	/**
	* 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(struct intel_sst_drv *sst_drv_ctx,
	int str_id, bool partial_drain)
	{
	int retval = 0;
	struct stream_info *str_info;

	dev_dbg(sst_drv_ctx->dev, "SST DBG:sst_drain_stream for %d\n", str_id);
	str_info = get_stream_info(sst_drv_ctx, str_id);
	if (!str_info)
	return -EINVAL;
	if (str_info->status != STREAM_RUNNING &&
	str_info->status != STREAM_INIT &&
	str_info->status != STREAM_PAUSED) {
	dev_err(sst_drv_ctx->dev, "SST ERR: BADQRC for stream = %d\n",
	str_info->status);
	return -EBADRQC;
	}

	retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id, IPC_CMD,
	IPC_IA_DRAIN_STREAM_MRFLD, str_info->pipe_id,
	sizeof(u8), &partial_drain, NULL, true, true, false, false);
	/*
	* with new non blocked drain implementation in core we dont need to
	* wait for respsonse, and need to only invoke callback for drain
	* complete
	*/

	return retval;
	}

	/**
	* 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(struct intel_sst_drv *sst_drv_ctx, int str_id)
	{
	int retval = 0;
	struct stream_info *str_info;
	struct intel_sst_ops *ops;

	dev_dbg(sst_drv_ctx->dev, "SST DBG:sst_free_stream for %d\n", str_id);

	mutex_lock(&sst_drv_ctx->sst_lock);
	if (sst_drv_ctx->sst_state == SST_RESET) {
	mutex_unlock(&sst_drv_ctx->sst_lock);
	return -ENODEV;
	}
	mutex_unlock(&sst_drv_ctx->sst_lock);
	str_info = get_stream_info(sst_drv_ctx, 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);

	dev_info(sst_drv_ctx->dev, "Free for str %d pipe %#x\n",
	str_id, str_info->pipe_id);
	retval = sst_prepare_and_post_msg(sst_drv_ctx, str_info->task_id, IPC_CMD,
	IPC_IA_FREE_STREAM_MRFLD, str_info->pipe_id, 0,
	NULL, NULL, true, true, false, true);

	dev_dbg(sst_drv_ctx->dev, "sst: wait for free returned %d\n",
	retval);
	mutex_lock(&sst_drv_ctx->sst_lock);
	sst_clean_stream(str_info);
	mutex_unlock(&sst_drv_ctx->sst_lock);
	dev_dbg(sst_drv_ctx->dev, "SST DBG:Stream freed\n");
	} else {
	mutex_unlock(&str_info->lock);
	retval = -EBADRQC;
	dev_dbg(sst_drv_ctx->dev, "SST DBG:BADQRC for stream\n");
	}

	return retval;
	}