The usage_count variable was read before it was set to the correct value, due to which the firmware load was failing. Because of this IPC messages sent to the firmware were timing out causing a delay of about 1 second while playing audio from the internal speakers. With this patch the usage_count is read after the function call pm_runtime_get_sync which will increment the usage_count variable and the firmware load is successful and all the IPC messages are processed correctly. Signed-off-by: Shilpa Sreeramalu <shilpa.sreeramalu@intel.com> Signed-off-by: Fang, Yang A <yang.a.fang@intel.com> Signed-off-by: Mark Brown <broonie@kernel.org> Cc: stable@vger.kernel.org
742 lines
19 KiB
C
742 lines
19 KiB
C
/*
|
|
* sst_drv_interface.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)
|
|
* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
|
|
*
|
|
* 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/delay.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/fs.h>
|
|
#include <linux/firmware.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/pm_qos.h>
|
|
#include <linux/math64.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"
|
|
|
|
|
|
|
|
#define NUM_CODEC 2
|
|
#define MIN_FRAGMENT 2
|
|
#define MAX_FRAGMENT 4
|
|
#define MIN_FRAGMENT_SIZE (50 * 1024)
|
|
#define MAX_FRAGMENT_SIZE (1024 * 1024)
|
|
#define SST_GET_BYTES_PER_SAMPLE(pcm_wd_sz) (((pcm_wd_sz + 15) >> 4) << 1)
|
|
#ifdef CONFIG_PM
|
|
#define GET_USAGE_COUNT(dev) (atomic_read(&dev->power.usage_count))
|
|
#else
|
|
#define GET_USAGE_COUNT(dev) 1
|
|
#endif
|
|
|
|
int free_stream_context(struct intel_sst_drv *ctx, unsigned int str_id)
|
|
{
|
|
struct stream_info *stream;
|
|
int ret = 0;
|
|
|
|
stream = get_stream_info(ctx, str_id);
|
|
if (stream) {
|
|
/* str_id is valid, so stream is alloacted */
|
|
ret = sst_free_stream(ctx, str_id);
|
|
if (ret)
|
|
sst_clean_stream(&ctx->streams[str_id]);
|
|
return ret;
|
|
} else {
|
|
dev_err(ctx->dev, "we tried to free stream context %d which was freed!!!\n", str_id);
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
int sst_get_stream_allocated(struct intel_sst_drv *ctx,
|
|
struct snd_sst_params *str_param,
|
|
struct snd_sst_lib_download **lib_dnld)
|
|
{
|
|
int retval;
|
|
|
|
retval = ctx->ops->alloc_stream(ctx, str_param);
|
|
if (retval > 0)
|
|
dev_dbg(ctx->dev, "Stream allocated %d\n", retval);
|
|
return retval;
|
|
|
|
}
|
|
|
|
/*
|
|
* sst_get_sfreq - this function returns the frequency of the stream
|
|
*
|
|
* @str_param : stream params
|
|
*/
|
|
int sst_get_sfreq(struct snd_sst_params *str_param)
|
|
{
|
|
switch (str_param->codec) {
|
|
case SST_CODEC_TYPE_PCM:
|
|
return str_param->sparams.uc.pcm_params.sfreq;
|
|
case SST_CODEC_TYPE_AAC:
|
|
return str_param->sparams.uc.aac_params.externalsr;
|
|
case SST_CODEC_TYPE_MP3:
|
|
return 0;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* sst_get_num_channel - get number of channels for the stream
|
|
*
|
|
* @str_param : stream params
|
|
*/
|
|
int sst_get_num_channel(struct snd_sst_params *str_param)
|
|
{
|
|
switch (str_param->codec) {
|
|
case SST_CODEC_TYPE_PCM:
|
|
return str_param->sparams.uc.pcm_params.num_chan;
|
|
case SST_CODEC_TYPE_MP3:
|
|
return str_param->sparams.uc.mp3_params.num_chan;
|
|
case SST_CODEC_TYPE_AAC:
|
|
return str_param->sparams.uc.aac_params.num_chan;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* sst_get_stream - this function prepares for stream allocation
|
|
*
|
|
* @str_param : stream param
|
|
*/
|
|
int sst_get_stream(struct intel_sst_drv *ctx,
|
|
struct snd_sst_params *str_param)
|
|
{
|
|
int retval;
|
|
struct stream_info *str_info;
|
|
|
|
/* stream is not allocated, we are allocating */
|
|
retval = ctx->ops->alloc_stream(ctx, str_param);
|
|
if (retval <= 0) {
|
|
return -EIO;
|
|
}
|
|
/* store sampling freq */
|
|
str_info = &ctx->streams[retval];
|
|
str_info->sfreq = sst_get_sfreq(str_param);
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int sst_power_control(struct device *dev, bool state)
|
|
{
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
int ret = 0;
|
|
int usage_count = 0;
|
|
|
|
if (state == true) {
|
|
ret = pm_runtime_get_sync(dev);
|
|
usage_count = GET_USAGE_COUNT(dev);
|
|
dev_dbg(ctx->dev, "Enable: pm usage count: %d\n", usage_count);
|
|
if (ret < 0) {
|
|
dev_err(ctx->dev, "Runtime get failed with err: %d\n", ret);
|
|
return ret;
|
|
}
|
|
if ((ctx->sst_state == SST_RESET) && (usage_count == 1)) {
|
|
ret = sst_load_fw(ctx);
|
|
if (ret) {
|
|
dev_err(dev, "FW download fail %d\n", ret);
|
|
sst_set_fw_state_locked(ctx, SST_RESET);
|
|
ret = sst_pm_runtime_put(ctx);
|
|
}
|
|
}
|
|
} else {
|
|
usage_count = GET_USAGE_COUNT(dev);
|
|
dev_dbg(ctx->dev, "Disable: pm usage count: %d\n", usage_count);
|
|
return sst_pm_runtime_put(ctx);
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* sst_open_pcm_stream - Open PCM interface
|
|
*
|
|
* @str_param: parameters of pcm stream
|
|
*
|
|
* This function is called by MID sound card driver to open
|
|
* a new pcm interface
|
|
*/
|
|
static int sst_open_pcm_stream(struct device *dev,
|
|
struct snd_sst_params *str_param)
|
|
{
|
|
int retval;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
if (!str_param)
|
|
return -EINVAL;
|
|
|
|
retval = sst_get_stream(ctx, str_param);
|
|
if (retval > 0)
|
|
ctx->stream_cnt++;
|
|
else
|
|
dev_err(ctx->dev, "sst_get_stream returned err %d\n", retval);
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int sst_cdev_open(struct device *dev,
|
|
struct snd_sst_params *str_params, struct sst_compress_cb *cb)
|
|
{
|
|
int str_id, retval;
|
|
struct stream_info *stream;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
retval = pm_runtime_get_sync(ctx->dev);
|
|
if (retval < 0)
|
|
return retval;
|
|
|
|
str_id = sst_get_stream(ctx, str_params);
|
|
if (str_id > 0) {
|
|
dev_dbg(dev, "stream allocated in sst_cdev_open %d\n", str_id);
|
|
stream = &ctx->streams[str_id];
|
|
stream->compr_cb = cb->compr_cb;
|
|
stream->compr_cb_param = cb->param;
|
|
stream->drain_notify = cb->drain_notify;
|
|
stream->drain_cb_param = cb->drain_cb_param;
|
|
} else {
|
|
dev_err(dev, "stream encountered error during alloc %d\n", str_id);
|
|
str_id = -EINVAL;
|
|
sst_pm_runtime_put(ctx);
|
|
}
|
|
return str_id;
|
|
}
|
|
|
|
static int sst_cdev_close(struct device *dev, unsigned int str_id)
|
|
{
|
|
int retval;
|
|
struct stream_info *stream;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
stream = get_stream_info(ctx, str_id);
|
|
if (!stream) {
|
|
dev_err(dev, "stream info is NULL for str %d!!!\n", str_id);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (stream->status == STREAM_RESET) {
|
|
dev_dbg(dev, "stream in reset state...\n");
|
|
stream->status = STREAM_UN_INIT;
|
|
|
|
retval = 0;
|
|
goto put;
|
|
}
|
|
|
|
retval = sst_free_stream(ctx, str_id);
|
|
put:
|
|
stream->compr_cb_param = NULL;
|
|
stream->compr_cb = NULL;
|
|
|
|
if (retval)
|
|
dev_err(dev, "free stream returned err %d\n", retval);
|
|
|
|
dev_dbg(dev, "End\n");
|
|
return retval;
|
|
|
|
}
|
|
|
|
static int sst_cdev_ack(struct device *dev, unsigned int str_id,
|
|
unsigned long bytes)
|
|
{
|
|
struct stream_info *stream;
|
|
struct snd_sst_tstamp fw_tstamp = {0,};
|
|
int offset;
|
|
void __iomem *addr;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
stream = get_stream_info(ctx, str_id);
|
|
if (!stream)
|
|
return -EINVAL;
|
|
|
|
/* update bytes sent */
|
|
stream->cumm_bytes += bytes;
|
|
dev_dbg(dev, "bytes copied %d inc by %ld\n", stream->cumm_bytes, bytes);
|
|
|
|
memcpy_fromio(&fw_tstamp,
|
|
((void *)(ctx->mailbox + ctx->tstamp)
|
|
+(str_id * sizeof(fw_tstamp))),
|
|
sizeof(fw_tstamp));
|
|
|
|
fw_tstamp.bytes_copied = stream->cumm_bytes;
|
|
dev_dbg(dev, "bytes sent to fw %llu inc by %ld\n",
|
|
fw_tstamp.bytes_copied, bytes);
|
|
|
|
addr = ((void *)(ctx->mailbox + ctx->tstamp)) +
|
|
(str_id * sizeof(fw_tstamp));
|
|
offset = offsetof(struct snd_sst_tstamp, bytes_copied);
|
|
sst_shim_write(addr, offset, fw_tstamp.bytes_copied);
|
|
return 0;
|
|
}
|
|
|
|
static int sst_cdev_set_metadata(struct device *dev,
|
|
unsigned int str_id, struct snd_compr_metadata *metadata)
|
|
{
|
|
int retval = 0;
|
|
struct stream_info *str_info;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
dev_dbg(dev, "set metadata for stream %d\n", str_id);
|
|
|
|
str_info = get_stream_info(ctx, str_id);
|
|
if (!str_info)
|
|
return -EINVAL;
|
|
|
|
dev_dbg(dev, "pipe id = %d\n", str_info->pipe_id);
|
|
retval = sst_prepare_and_post_msg(ctx, str_info->task_id, IPC_CMD,
|
|
IPC_IA_SET_STREAM_PARAMS_MRFLD, str_info->pipe_id,
|
|
sizeof(*metadata), metadata, NULL,
|
|
true, true, true, false);
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int sst_cdev_stream_pause(struct device *dev, unsigned int str_id)
|
|
{
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
return sst_pause_stream(ctx, str_id);
|
|
}
|
|
|
|
static int sst_cdev_stream_pause_release(struct device *dev,
|
|
unsigned int str_id)
|
|
{
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
return sst_resume_stream(ctx, str_id);
|
|
}
|
|
|
|
static int sst_cdev_stream_start(struct device *dev, unsigned int str_id)
|
|
{
|
|
struct stream_info *str_info;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
str_info = get_stream_info(ctx, str_id);
|
|
if (!str_info)
|
|
return -EINVAL;
|
|
str_info->prev = str_info->status;
|
|
str_info->status = STREAM_RUNNING;
|
|
return sst_start_stream(ctx, str_id);
|
|
}
|
|
|
|
static int sst_cdev_stream_drop(struct device *dev, unsigned int str_id)
|
|
{
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
return sst_drop_stream(ctx, str_id);
|
|
}
|
|
|
|
static int sst_cdev_stream_drain(struct device *dev, unsigned int str_id)
|
|
{
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
return sst_drain_stream(ctx, str_id, false);
|
|
}
|
|
|
|
static int sst_cdev_stream_partial_drain(struct device *dev,
|
|
unsigned int str_id)
|
|
{
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
return sst_drain_stream(ctx, str_id, true);
|
|
}
|
|
|
|
static int sst_cdev_tstamp(struct device *dev, unsigned int str_id,
|
|
struct snd_compr_tstamp *tstamp)
|
|
{
|
|
struct snd_sst_tstamp fw_tstamp = {0,};
|
|
struct stream_info *stream;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
memcpy_fromio(&fw_tstamp,
|
|
((void *)(ctx->mailbox + ctx->tstamp)
|
|
+(str_id * sizeof(fw_tstamp))),
|
|
sizeof(fw_tstamp));
|
|
|
|
stream = get_stream_info(ctx, str_id);
|
|
if (!stream)
|
|
return -EINVAL;
|
|
dev_dbg(dev, "rb_counter %llu in bytes\n", fw_tstamp.ring_buffer_counter);
|
|
|
|
tstamp->copied_total = fw_tstamp.ring_buffer_counter;
|
|
tstamp->pcm_frames = fw_tstamp.frames_decoded;
|
|
tstamp->pcm_io_frames = div_u64(fw_tstamp.hardware_counter,
|
|
(u64)stream->num_ch * SST_GET_BYTES_PER_SAMPLE(24));
|
|
tstamp->sampling_rate = fw_tstamp.sampling_frequency;
|
|
|
|
dev_dbg(dev, "PCM = %u\n", tstamp->pcm_io_frames);
|
|
dev_dbg(dev, "Ptr Query on strid = %d copied_total %d, decodec %d\n",
|
|
str_id, tstamp->copied_total, tstamp->pcm_frames);
|
|
dev_dbg(dev, "rendered %d\n", tstamp->pcm_io_frames);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sst_cdev_caps(struct snd_compr_caps *caps)
|
|
{
|
|
caps->num_codecs = NUM_CODEC;
|
|
caps->min_fragment_size = MIN_FRAGMENT_SIZE; /* 50KB */
|
|
caps->max_fragment_size = MAX_FRAGMENT_SIZE; /* 1024KB */
|
|
caps->min_fragments = MIN_FRAGMENT;
|
|
caps->max_fragments = MAX_FRAGMENT;
|
|
caps->codecs[0] = SND_AUDIOCODEC_MP3;
|
|
caps->codecs[1] = SND_AUDIOCODEC_AAC;
|
|
return 0;
|
|
}
|
|
|
|
static struct snd_compr_codec_caps caps_mp3 = {
|
|
.num_descriptors = 1,
|
|
.descriptor[0].max_ch = 2,
|
|
.descriptor[0].sample_rates[0] = 48000,
|
|
.descriptor[0].sample_rates[1] = 44100,
|
|
.descriptor[0].sample_rates[2] = 32000,
|
|
.descriptor[0].sample_rates[3] = 16000,
|
|
.descriptor[0].sample_rates[4] = 8000,
|
|
.descriptor[0].num_sample_rates = 5,
|
|
.descriptor[0].bit_rate[0] = 320,
|
|
.descriptor[0].bit_rate[1] = 192,
|
|
.descriptor[0].num_bitrates = 2,
|
|
.descriptor[0].profiles = 0,
|
|
.descriptor[0].modes = SND_AUDIOCHANMODE_MP3_STEREO,
|
|
.descriptor[0].formats = 0,
|
|
};
|
|
|
|
static struct snd_compr_codec_caps caps_aac = {
|
|
.num_descriptors = 2,
|
|
.descriptor[1].max_ch = 2,
|
|
.descriptor[0].sample_rates[0] = 48000,
|
|
.descriptor[0].sample_rates[1] = 44100,
|
|
.descriptor[0].sample_rates[2] = 32000,
|
|
.descriptor[0].sample_rates[3] = 16000,
|
|
.descriptor[0].sample_rates[4] = 8000,
|
|
.descriptor[0].num_sample_rates = 5,
|
|
.descriptor[1].bit_rate[0] = 320,
|
|
.descriptor[1].bit_rate[1] = 192,
|
|
.descriptor[1].num_bitrates = 2,
|
|
.descriptor[1].profiles = 0,
|
|
.descriptor[1].modes = 0,
|
|
.descriptor[1].formats =
|
|
(SND_AUDIOSTREAMFORMAT_MP4ADTS |
|
|
SND_AUDIOSTREAMFORMAT_RAW),
|
|
};
|
|
|
|
static int sst_cdev_codec_caps(struct snd_compr_codec_caps *codec)
|
|
{
|
|
if (codec->codec == SND_AUDIOCODEC_MP3)
|
|
*codec = caps_mp3;
|
|
else if (codec->codec == SND_AUDIOCODEC_AAC)
|
|
*codec = caps_aac;
|
|
else
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void sst_cdev_fragment_elapsed(struct intel_sst_drv *ctx, int str_id)
|
|
{
|
|
struct stream_info *stream;
|
|
|
|
dev_dbg(ctx->dev, "fragment elapsed from firmware for str_id %d\n",
|
|
str_id);
|
|
stream = &ctx->streams[str_id];
|
|
if (stream->compr_cb)
|
|
stream->compr_cb(stream->compr_cb_param);
|
|
}
|
|
|
|
/*
|
|
* sst_close_pcm_stream - Close PCM interface
|
|
*
|
|
* @str_id: stream id to be closed
|
|
*
|
|
* This function is called by MID sound card driver to close
|
|
* an existing pcm interface
|
|
*/
|
|
static int sst_close_pcm_stream(struct device *dev, unsigned int str_id)
|
|
{
|
|
struct stream_info *stream;
|
|
int retval = 0;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
stream = get_stream_info(ctx, str_id);
|
|
if (!stream) {
|
|
dev_err(ctx->dev, "stream info is NULL for str %d!!!\n", str_id);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (stream->status == STREAM_RESET) {
|
|
/* silently fail here as we have cleaned the stream earlier */
|
|
dev_dbg(ctx->dev, "stream in reset state...\n");
|
|
|
|
retval = 0;
|
|
goto put;
|
|
}
|
|
|
|
retval = free_stream_context(ctx, str_id);
|
|
put:
|
|
stream->pcm_substream = NULL;
|
|
stream->status = STREAM_UN_INIT;
|
|
stream->period_elapsed = NULL;
|
|
ctx->stream_cnt--;
|
|
|
|
if (retval)
|
|
dev_err(ctx->dev, "free stream returned err %d\n", retval);
|
|
|
|
dev_dbg(ctx->dev, "Exit\n");
|
|
return 0;
|
|
}
|
|
|
|
static inline int sst_calc_tstamp(struct intel_sst_drv *ctx,
|
|
struct pcm_stream_info *info,
|
|
struct snd_pcm_substream *substream,
|
|
struct snd_sst_tstamp *fw_tstamp)
|
|
{
|
|
size_t delay_bytes, delay_frames;
|
|
size_t buffer_sz;
|
|
u32 pointer_bytes, pointer_samples;
|
|
|
|
dev_dbg(ctx->dev, "mrfld ring_buffer_counter %llu in bytes\n",
|
|
fw_tstamp->ring_buffer_counter);
|
|
dev_dbg(ctx->dev, "mrfld hardware_counter %llu in bytes\n",
|
|
fw_tstamp->hardware_counter);
|
|
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
|
|
delay_bytes = (size_t) (fw_tstamp->ring_buffer_counter -
|
|
fw_tstamp->hardware_counter);
|
|
else
|
|
delay_bytes = (size_t) (fw_tstamp->hardware_counter -
|
|
fw_tstamp->ring_buffer_counter);
|
|
delay_frames = bytes_to_frames(substream->runtime, delay_bytes);
|
|
buffer_sz = snd_pcm_lib_buffer_bytes(substream);
|
|
div_u64_rem(fw_tstamp->ring_buffer_counter, buffer_sz, &pointer_bytes);
|
|
pointer_samples = bytes_to_samples(substream->runtime, pointer_bytes);
|
|
|
|
dev_dbg(ctx->dev, "pcm delay %zu in bytes\n", delay_bytes);
|
|
|
|
info->buffer_ptr = pointer_samples / substream->runtime->channels;
|
|
|
|
info->pcm_delay = delay_frames;
|
|
dev_dbg(ctx->dev, "buffer ptr %llu pcm_delay rep: %llu\n",
|
|
info->buffer_ptr, info->pcm_delay);
|
|
return 0;
|
|
}
|
|
|
|
static int sst_read_timestamp(struct device *dev, struct pcm_stream_info *info)
|
|
{
|
|
struct stream_info *stream;
|
|
struct snd_pcm_substream *substream;
|
|
struct snd_sst_tstamp fw_tstamp;
|
|
unsigned int str_id;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
str_id = info->str_id;
|
|
stream = get_stream_info(ctx, str_id);
|
|
if (!stream)
|
|
return -EINVAL;
|
|
|
|
if (!stream->pcm_substream)
|
|
return -EINVAL;
|
|
substream = stream->pcm_substream;
|
|
|
|
memcpy_fromio(&fw_tstamp,
|
|
((void *)(ctx->mailbox + ctx->tstamp)
|
|
+ (str_id * sizeof(fw_tstamp))),
|
|
sizeof(fw_tstamp));
|
|
return sst_calc_tstamp(ctx, info, substream, &fw_tstamp);
|
|
}
|
|
|
|
static int sst_stream_start(struct device *dev, int str_id)
|
|
{
|
|
struct stream_info *str_info;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
if (ctx->sst_state != SST_FW_RUNNING)
|
|
return 0;
|
|
str_info = get_stream_info(ctx, str_id);
|
|
if (!str_info)
|
|
return -EINVAL;
|
|
str_info->prev = str_info->status;
|
|
str_info->status = STREAM_RUNNING;
|
|
sst_start_stream(ctx, str_id);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sst_stream_drop(struct device *dev, int str_id)
|
|
{
|
|
struct stream_info *str_info;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
if (ctx->sst_state != SST_FW_RUNNING)
|
|
return 0;
|
|
|
|
str_info = get_stream_info(ctx, str_id);
|
|
if (!str_info)
|
|
return -EINVAL;
|
|
str_info->prev = STREAM_UN_INIT;
|
|
str_info->status = STREAM_INIT;
|
|
return sst_drop_stream(ctx, str_id);
|
|
}
|
|
|
|
static int sst_stream_pause(struct device *dev, int str_id)
|
|
{
|
|
struct stream_info *str_info;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
if (ctx->sst_state != SST_FW_RUNNING)
|
|
return 0;
|
|
|
|
str_info = get_stream_info(ctx, str_id);
|
|
if (!str_info)
|
|
return -EINVAL;
|
|
|
|
return sst_pause_stream(ctx, str_id);
|
|
}
|
|
|
|
static int sst_stream_resume(struct device *dev, int str_id)
|
|
{
|
|
struct stream_info *str_info;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
if (ctx->sst_state != SST_FW_RUNNING)
|
|
return 0;
|
|
|
|
str_info = get_stream_info(ctx, str_id);
|
|
if (!str_info)
|
|
return -EINVAL;
|
|
return sst_resume_stream(ctx, str_id);
|
|
}
|
|
|
|
static int sst_stream_init(struct device *dev, struct pcm_stream_info *str_info)
|
|
{
|
|
int str_id = 0;
|
|
struct stream_info *stream;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
str_id = str_info->str_id;
|
|
|
|
if (ctx->sst_state != SST_FW_RUNNING)
|
|
return 0;
|
|
|
|
stream = get_stream_info(ctx, str_id);
|
|
if (!stream)
|
|
return -EINVAL;
|
|
|
|
dev_dbg(ctx->dev, "setting the period ptrs\n");
|
|
stream->pcm_substream = str_info->arg;
|
|
stream->period_elapsed = str_info->period_elapsed;
|
|
stream->sfreq = str_info->sfreq;
|
|
stream->prev = stream->status;
|
|
stream->status = STREAM_INIT;
|
|
dev_dbg(ctx->dev,
|
|
"pcm_substream %p, period_elapsed %p, sfreq %d, status %d\n",
|
|
stream->pcm_substream, stream->period_elapsed,
|
|
stream->sfreq, stream->status);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* sst_set_byte_stream - Set generic params
|
|
*
|
|
* @cmd: control cmd to be set
|
|
* @arg: command argument
|
|
*
|
|
* This function is called by MID sound card driver to configure
|
|
* SST runtime params.
|
|
*/
|
|
static int sst_send_byte_stream(struct device *dev,
|
|
struct snd_sst_bytes_v2 *bytes)
|
|
{
|
|
int ret_val = 0;
|
|
struct intel_sst_drv *ctx = dev_get_drvdata(dev);
|
|
|
|
if (NULL == bytes)
|
|
return -EINVAL;
|
|
ret_val = pm_runtime_get_sync(ctx->dev);
|
|
if (ret_val < 0)
|
|
return ret_val;
|
|
|
|
ret_val = sst_send_byte_stream_mrfld(ctx, bytes);
|
|
sst_pm_runtime_put(ctx);
|
|
|
|
return ret_val;
|
|
}
|
|
|
|
static struct sst_ops pcm_ops = {
|
|
.open = sst_open_pcm_stream,
|
|
.stream_init = sst_stream_init,
|
|
.stream_start = sst_stream_start,
|
|
.stream_drop = sst_stream_drop,
|
|
.stream_pause = sst_stream_pause,
|
|
.stream_pause_release = sst_stream_resume,
|
|
.stream_read_tstamp = sst_read_timestamp,
|
|
.send_byte_stream = sst_send_byte_stream,
|
|
.close = sst_close_pcm_stream,
|
|
.power = sst_power_control,
|
|
};
|
|
|
|
static struct compress_sst_ops compr_ops = {
|
|
.open = sst_cdev_open,
|
|
.close = sst_cdev_close,
|
|
.stream_pause = sst_cdev_stream_pause,
|
|
.stream_pause_release = sst_cdev_stream_pause_release,
|
|
.stream_start = sst_cdev_stream_start,
|
|
.stream_drop = sst_cdev_stream_drop,
|
|
.stream_drain = sst_cdev_stream_drain,
|
|
.stream_partial_drain = sst_cdev_stream_partial_drain,
|
|
.tstamp = sst_cdev_tstamp,
|
|
.ack = sst_cdev_ack,
|
|
.get_caps = sst_cdev_caps,
|
|
.get_codec_caps = sst_cdev_codec_caps,
|
|
.set_metadata = sst_cdev_set_metadata,
|
|
.power = sst_power_control,
|
|
};
|
|
|
|
static struct sst_device sst_dsp_device = {
|
|
.name = "Intel(R) SST LPE",
|
|
.dev = NULL,
|
|
.ops = &pcm_ops,
|
|
.compr_ops = &compr_ops,
|
|
};
|
|
|
|
/*
|
|
* sst_register - function to register DSP
|
|
*
|
|
* This functions registers DSP with the platform driver
|
|
*/
|
|
int sst_register(struct device *dev)
|
|
{
|
|
int ret_val;
|
|
|
|
sst_dsp_device.dev = dev;
|
|
ret_val = sst_register_dsp(&sst_dsp_device);
|
|
if (ret_val)
|
|
dev_err(dev, "Unable to register DSP with platform driver\n");
|
|
|
|
return ret_val;
|
|
}
|
|
|
|
int sst_unregister(struct device *dev)
|
|
{
|
|
return sst_unregister_dsp(&sst_dsp_device);
|
|
}
|