2 * sst_mfld_platform.c - Intel MID Platform driver
4 * Copyright (C) 2010-2014 Intel Corp
5 * Author: Vinod Koul <vinod.koul@intel.com>
6 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; version 2 of the License.
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
17 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
19 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
21 #include <linux/slab.h>
23 #include <linux/module.h>
24 #include <sound/core.h>
25 #include <sound/pcm.h>
26 #include <sound/pcm_params.h>
27 #include <sound/soc.h>
28 #include <sound/compress_driver.h>
29 #include "sst-mfld-platform.h"
31 /* compress stream operations */
32 static void sst_compr_fragment_elapsed(void *arg)
34 struct snd_compr_stream *cstream = (struct snd_compr_stream *)arg;
36 pr_debug("fragment elapsed by driver\n");
38 snd_compr_fragment_elapsed(cstream);
41 static void sst_drain_notify(void *arg)
43 struct snd_compr_stream *cstream = (struct snd_compr_stream *)arg;
45 pr_debug("drain notify by driver\n");
47 snd_compr_drain_notify(cstream);
50 static int sst_platform_compr_open(struct snd_compr_stream *cstream)
54 struct snd_compr_runtime *runtime = cstream->runtime;
55 struct sst_runtime_stream *stream;
57 stream = kzalloc(sizeof(*stream), GFP_KERNEL);
61 spin_lock_init(&stream->status_lock);
64 if (!sst || !try_module_get(sst->dev->driver->owner)) {
65 pr_err("no device available to run\n");
69 stream->compr_ops = sst->compr_ops;
72 sst_set_stream_status(stream, SST_PLATFORM_INIT);
73 runtime->private_data = stream;
80 static int sst_platform_compr_free(struct snd_compr_stream *cstream)
82 struct sst_runtime_stream *stream;
83 int ret_val = 0, str_id;
85 stream = cstream->runtime->private_data;
89 ret_val = stream->compr_ops->close(str_id);
90 module_put(sst->dev->driver->owner);
92 pr_debug("%s: %d\n", __func__, ret_val);
96 static int sst_platform_compr_set_params(struct snd_compr_stream *cstream,
97 struct snd_compr_params *params)
99 struct sst_runtime_stream *stream;
101 struct snd_sst_params str_params;
102 struct sst_compress_cb cb;
104 stream = cstream->runtime->private_data;
105 /* construct fw structure for this*/
106 memset(&str_params, 0, sizeof(str_params));
108 str_params.ops = STREAM_OPS_PLAYBACK;
109 str_params.stream_type = SST_STREAM_TYPE_MUSIC;
110 str_params.device_type = SND_SST_DEVICE_COMPRESS;
112 switch (params->codec.id) {
113 case SND_AUDIOCODEC_MP3: {
114 str_params.codec = SST_CODEC_TYPE_MP3;
115 str_params.sparams.uc.mp3_params.num_chan = params->codec.ch_in;
116 str_params.sparams.uc.mp3_params.pcm_wd_sz = 16;
120 case SND_AUDIOCODEC_AAC: {
121 str_params.codec = SST_CODEC_TYPE_AAC;
122 str_params.sparams.uc.aac_params.num_chan = params->codec.ch_in;
123 str_params.sparams.uc.aac_params.pcm_wd_sz = 16;
124 if (params->codec.format == SND_AUDIOSTREAMFORMAT_MP4ADTS)
125 str_params.sparams.uc.aac_params.bs_format =
127 else if (params->codec.format == SND_AUDIOSTREAMFORMAT_RAW)
128 str_params.sparams.uc.aac_params.bs_format =
131 pr_err("Undefined format%d\n", params->codec.format);
134 str_params.sparams.uc.aac_params.externalsr =
135 params->codec.sample_rate;
140 pr_err("codec not supported, id =%d\n", params->codec.id);
144 str_params.aparams.ring_buf_info[0].addr =
145 virt_to_phys(cstream->runtime->buffer);
146 str_params.aparams.ring_buf_info[0].size =
147 cstream->runtime->buffer_size;
148 str_params.aparams.sg_count = 1;
149 str_params.aparams.frag_size = cstream->runtime->fragment_size;
152 cb.compr_cb = sst_compr_fragment_elapsed;
153 cb.drain_cb_param = cstream;
154 cb.drain_notify = sst_drain_notify;
156 retval = stream->compr_ops->open(&str_params, &cb);
158 pr_err("stream allocation failed %d\n", retval);
166 static int sst_platform_compr_trigger(struct snd_compr_stream *cstream, int cmd)
168 struct sst_runtime_stream *stream =
169 cstream->runtime->private_data;
171 return stream->compr_ops->control(cmd, stream->id);
174 static int sst_platform_compr_pointer(struct snd_compr_stream *cstream,
175 struct snd_compr_tstamp *tstamp)
177 struct sst_runtime_stream *stream;
179 stream = cstream->runtime->private_data;
180 stream->compr_ops->tstamp(stream->id, tstamp);
181 tstamp->byte_offset = tstamp->copied_total %
182 (u32)cstream->runtime->buffer_size;
183 pr_debug("calc bytes offset/copied bytes as %d\n", tstamp->byte_offset);
187 static int sst_platform_compr_ack(struct snd_compr_stream *cstream,
190 struct sst_runtime_stream *stream;
192 stream = cstream->runtime->private_data;
193 stream->compr_ops->ack(stream->id, (unsigned long)bytes);
194 stream->bytes_written += bytes;
199 static int sst_platform_compr_get_caps(struct snd_compr_stream *cstream,
200 struct snd_compr_caps *caps)
202 struct sst_runtime_stream *stream =
203 cstream->runtime->private_data;
205 return stream->compr_ops->get_caps(caps);
208 static int sst_platform_compr_get_codec_caps(struct snd_compr_stream *cstream,
209 struct snd_compr_codec_caps *codec)
211 struct sst_runtime_stream *stream =
212 cstream->runtime->private_data;
214 return stream->compr_ops->get_codec_caps(codec);
217 static int sst_platform_compr_set_metadata(struct snd_compr_stream *cstream,
218 struct snd_compr_metadata *metadata)
220 struct sst_runtime_stream *stream =
221 cstream->runtime->private_data;
223 return stream->compr_ops->set_metadata(stream->id, metadata);
226 struct snd_compr_ops sst_platform_compr_ops = {
228 .open = sst_platform_compr_open,
229 .free = sst_platform_compr_free,
230 .set_params = sst_platform_compr_set_params,
231 .set_metadata = sst_platform_compr_set_metadata,
232 .trigger = sst_platform_compr_trigger,
233 .pointer = sst_platform_compr_pointer,
234 .ack = sst_platform_compr_ack,
235 .get_caps = sst_platform_compr_get_caps,
236 .get_codec_caps = sst_platform_compr_get_codec_caps,