blob: 4c734f5aeb8b21d5789e9df982866ceda1d226d3 [file] [log] [blame]
Vinod Kould927fda2011-01-04 20:16:32 +05301/*
Mark Browna4b12992014-03-12 23:04:35 +00002 * sst_mfld_platform.c - Intel MID Platform driver
Vinod Kould927fda2011-01-04 20:16:32 +05303 *
Vinod Koul61b165c2014-06-13 18:03:56 +05304 * Copyright (C) 2010-2014 Intel Corp
Vinod Kould927fda2011-01-04 20:16:32 +05305 * Author: Vinod Koul <vinod.koul@intel.com>
6 * Author: Harsha Priya <priya.harsha@intel.com>
7 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; version 2 of the License.
12 *
13 * This program is distributed in the hope that it will be useful, but
14 * WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 * General Public License for more details.
17 *
Vinod Kould927fda2011-01-04 20:16:32 +053018 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
Vinod Kould927fda2011-01-04 20:16:32 +053019 */
20#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
21
22#include <linux/slab.h>
23#include <linux/io.h>
Paul Gortmakerda155d52011-07-15 12:38:28 -040024#include <linux/module.h>
Vinod Kould927fda2011-01-04 20:16:32 +053025#include <sound/core.h>
26#include <sound/pcm.h>
27#include <sound/pcm_params.h>
28#include <sound/soc.h>
Vinod Koulc514a912012-08-16 17:10:42 +053029#include <sound/compress_driver.h>
Vinod Koul61b165c2014-06-13 18:03:56 +053030#include <asm/platform_sst_audio.h>
Mark Browna4b12992014-03-12 23:04:35 +000031#include "sst-mfld-platform.h"
Vinod Koul61b165c2014-06-13 18:03:56 +053032#include "sst-atom-controls.h"
Vinod Kould927fda2011-01-04 20:16:32 +053033
Vinod Koul4b68b4e2014-05-05 14:27:50 +053034struct sst_device *sst;
Vinod Koul03c33042011-12-05 19:13:41 +053035static DEFINE_MUTEX(sst_lock);
36
37int sst_register_dsp(struct sst_device *dev)
38{
Takashi Iwai656a22a2013-11-05 18:40:01 +010039 if (WARN_ON(!dev))
40 return -EINVAL;
Vinod Koul03c33042011-12-05 19:13:41 +053041 if (!try_module_get(dev->dev->driver->owner))
42 return -ENODEV;
43 mutex_lock(&sst_lock);
44 if (sst) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +053045 dev_err(dev->dev, "we already have a device %s\n", sst->name);
Vinod Koul03c33042011-12-05 19:13:41 +053046 module_put(dev->dev->driver->owner);
47 mutex_unlock(&sst_lock);
48 return -EEXIST;
49 }
Subhransu S. Prusty02024752014-09-02 18:05:56 +053050 dev_dbg(dev->dev, "registering device %s\n", dev->name);
Vinod Koul03c33042011-12-05 19:13:41 +053051 sst = dev;
52 mutex_unlock(&sst_lock);
53 return 0;
54}
55EXPORT_SYMBOL_GPL(sst_register_dsp);
56
57int sst_unregister_dsp(struct sst_device *dev)
58{
Takashi Iwai656a22a2013-11-05 18:40:01 +010059 if (WARN_ON(!dev))
60 return -EINVAL;
Vinod Koul03c33042011-12-05 19:13:41 +053061 if (dev != sst)
62 return -EINVAL;
63
64 mutex_lock(&sst_lock);
65
66 if (!sst) {
67 mutex_unlock(&sst_lock);
68 return -EIO;
69 }
70
71 module_put(sst->dev->driver->owner);
Subhransu S. Prusty02024752014-09-02 18:05:56 +053072 dev_dbg(dev->dev, "unreg %s\n", sst->name);
Vinod Koul03c33042011-12-05 19:13:41 +053073 sst = NULL;
74 mutex_unlock(&sst_lock);
75 return 0;
76}
77EXPORT_SYMBOL_GPL(sst_unregister_dsp);
78
Vinod Kould927fda2011-01-04 20:16:32 +053079static struct snd_pcm_hardware sst_platform_pcm_hw = {
80 .info = (SNDRV_PCM_INFO_INTERLEAVED |
81 SNDRV_PCM_INFO_DOUBLE |
82 SNDRV_PCM_INFO_PAUSE |
83 SNDRV_PCM_INFO_RESUME |
84 SNDRV_PCM_INFO_MMAP|
85 SNDRV_PCM_INFO_MMAP_VALID |
86 SNDRV_PCM_INFO_BLOCK_TRANSFER |
87 SNDRV_PCM_INFO_SYNC_START),
Vinod Kould927fda2011-01-04 20:16:32 +053088 .buffer_bytes_max = SST_MAX_BUFFER,
89 .period_bytes_min = SST_MIN_PERIOD_BYTES,
90 .period_bytes_max = SST_MAX_PERIOD_BYTES,
91 .periods_min = SST_MIN_PERIODS,
92 .periods_max = SST_MAX_PERIODS,
93 .fifo_size = SST_FIFO_SIZE,
94};
95
Vinod Koul61b165c2014-06-13 18:03:56 +053096static struct sst_dev_stream_map dpcm_strm_map[] = {
97 {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF}, /* Reserved, not in use */
98 {MERR_DPCM_AUDIO, 0, SNDRV_PCM_STREAM_PLAYBACK, PIPE_MEDIA1_IN, SST_TASK_ID_MEDIA, 0},
99 {MERR_DPCM_COMPR, 0, SNDRV_PCM_STREAM_PLAYBACK, PIPE_MEDIA0_IN, SST_TASK_ID_MEDIA, 0},
100 {MERR_DPCM_AUDIO, 0, SNDRV_PCM_STREAM_CAPTURE, PIPE_PCM1_OUT, SST_TASK_ID_MEDIA, 0},
101};
102
Vinod Koulc82351d2014-10-15 20:12:59 +0530103static int sst_media_digital_mute(struct snd_soc_dai *dai, int mute, int stream)
Vinod Kould927fda2011-01-04 20:16:32 +0530104{
Vinod Koulc82351d2014-10-15 20:12:59 +0530105
106 return sst_send_pipe_gains(dai, stream, mute);
107}
Harsha Priya5c685362011-01-11 14:50:35 +0530108
Vinod Kould927fda2011-01-04 20:16:32 +0530109/* helper functions */
Vinod Koul4496ffa2014-05-05 14:27:49 +0530110void sst_set_stream_status(struct sst_runtime_stream *stream,
Harsha Priya5c685362011-01-11 14:50:35 +0530111 int state)
112{
Lu Guanqund89b0a12011-04-08 15:38:48 +0800113 unsigned long flags;
114 spin_lock_irqsave(&stream->status_lock, flags);
Harsha Priya5c685362011-01-11 14:50:35 +0530115 stream->stream_status = state;
Lu Guanqund89b0a12011-04-08 15:38:48 +0800116 spin_unlock_irqrestore(&stream->status_lock, flags);
Harsha Priya5c685362011-01-11 14:50:35 +0530117}
118
119static inline int sst_get_stream_status(struct sst_runtime_stream *stream)
120{
121 int state;
Lu Guanqund89b0a12011-04-08 15:38:48 +0800122 unsigned long flags;
Harsha Priya5c685362011-01-11 14:50:35 +0530123
Lu Guanqund89b0a12011-04-08 15:38:48 +0800124 spin_lock_irqsave(&stream->status_lock, flags);
Harsha Priya5c685362011-01-11 14:50:35 +0530125 state = stream->stream_status;
Lu Guanqund89b0a12011-04-08 15:38:48 +0800126 spin_unlock_irqrestore(&stream->status_lock, flags);
Harsha Priya5c685362011-01-11 14:50:35 +0530127 return state;
128}
129
Vinod Koula870cdc2014-06-13 18:03:55 +0530130static void sst_fill_alloc_params(struct snd_pcm_substream *substream,
131 struct snd_sst_alloc_params_ext *alloc_param)
Harsha Priya5c685362011-01-11 14:50:35 +0530132{
Vinod Koula870cdc2014-06-13 18:03:55 +0530133 unsigned int channels;
134 snd_pcm_uframes_t period_size;
135 ssize_t periodbytes;
136 ssize_t buffer_bytes = snd_pcm_lib_buffer_bytes(substream);
137 u32 buffer_addr = virt_to_phys(substream->dma_buffer.area);
Harsha Priya5c685362011-01-11 14:50:35 +0530138
Vinod Koula870cdc2014-06-13 18:03:55 +0530139 channels = substream->runtime->channels;
140 period_size = substream->runtime->period_size;
141 periodbytes = samples_to_bytes(substream->runtime, period_size);
142 alloc_param->ring_buf_info[0].addr = buffer_addr;
143 alloc_param->ring_buf_info[0].size = buffer_bytes;
144 alloc_param->sg_count = 1;
145 alloc_param->reserved = 0;
146 alloc_param->frag_size = periodbytes * channels;
147
148}
149static void sst_fill_pcm_params(struct snd_pcm_substream *substream,
150 struct snd_sst_stream_params *param)
151{
152 param->uc.pcm_params.num_chan = (u8) substream->runtime->channels;
153 param->uc.pcm_params.pcm_wd_sz = substream->runtime->sample_bits;
154 param->uc.pcm_params.sfreq = substream->runtime->rate;
155
156 /* PCM stream via ALSA interface */
157 param->uc.pcm_params.use_offload_path = 0;
158 param->uc.pcm_params.reserved2 = 0;
159 memset(param->uc.pcm_params.channel_map, 0, sizeof(u8));
160
161}
Vinod Koul61b165c2014-06-13 18:03:56 +0530162
163static int sst_get_stream_mapping(int dev, int sdev, int dir,
164 struct sst_dev_stream_map *map, int size)
Vinod Koula870cdc2014-06-13 18:03:55 +0530165{
Vinod Koul61b165c2014-06-13 18:03:56 +0530166 int i;
167
168 if (map == NULL)
169 return -EINVAL;
170
171
172 /* index 0 is not used in stream map */
173 for (i = 1; i < size; i++) {
174 if ((map[i].dev_num == dev) && (map[i].direction == dir))
175 return i;
176 }
177 return 0;
178}
179
180int sst_fill_stream_params(void *substream,
181 const struct sst_data *ctx, struct snd_sst_params *str_params, bool is_compress)
182{
183 int map_size;
184 int index;
185 struct sst_dev_stream_map *map;
Vinod Koula870cdc2014-06-13 18:03:55 +0530186 struct snd_pcm_substream *pstream = NULL;
187 struct snd_compr_stream *cstream = NULL;
188
Vinod Koul61b165c2014-06-13 18:03:56 +0530189 map = ctx->pdata->pdev_strm_map;
190 map_size = ctx->pdata->strm_map_size;
191
Vinod Koula870cdc2014-06-13 18:03:55 +0530192 if (is_compress == true)
193 cstream = (struct snd_compr_stream *)substream;
194 else
195 pstream = (struct snd_pcm_substream *)substream;
196
197 str_params->stream_type = SST_STREAM_TYPE_MUSIC;
198
199 /* For pcm streams */
Vinod Koul61b165c2014-06-13 18:03:56 +0530200 if (pstream) {
201 index = sst_get_stream_mapping(pstream->pcm->device,
202 pstream->number, pstream->stream,
203 map, map_size);
204 if (index <= 0)
205 return -EINVAL;
Vinod Koula870cdc2014-06-13 18:03:55 +0530206
Vinod Koul61b165c2014-06-13 18:03:56 +0530207 str_params->stream_id = index;
208 str_params->device_type = map[index].device_id;
209 str_params->task = map[index].task_id;
210
211 str_params->ops = (u8)pstream->stream;
212 }
213
214 if (cstream) {
215 index = sst_get_stream_mapping(cstream->device->device,
216 0, cstream->direction,
217 map, map_size);
218 if (index <= 0)
219 return -EINVAL;
220 str_params->stream_id = index;
221 str_params->device_type = map[index].device_id;
222 str_params->task = map[index].task_id;
223
224 str_params->ops = (u8)cstream->direction;
225 }
Vinod Koula870cdc2014-06-13 18:03:55 +0530226 return 0;
Harsha Priya5c685362011-01-11 14:50:35 +0530227}
228
Vinod Koula870cdc2014-06-13 18:03:55 +0530229static int sst_platform_alloc_stream(struct snd_pcm_substream *substream,
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530230 struct snd_soc_dai *dai)
Vinod Kould927fda2011-01-04 20:16:32 +0530231{
232 struct sst_runtime_stream *stream =
233 substream->runtime->private_data;
Vinod Koula870cdc2014-06-13 18:03:55 +0530234 struct snd_sst_stream_params param = {{{0,},},};
235 struct snd_sst_params str_params = {0};
236 struct snd_sst_alloc_params_ext alloc_params = {0};
237 int ret_val = 0;
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530238 struct sst_data *ctx = snd_soc_dai_get_drvdata(dai);
Vinod Kould927fda2011-01-04 20:16:32 +0530239
240 /* set codec params and inform SST driver the same */
Harsha Priya5c685362011-01-11 14:50:35 +0530241 sst_fill_pcm_params(substream, &param);
Vinod Koula870cdc2014-06-13 18:03:55 +0530242 sst_fill_alloc_params(substream, &alloc_params);
Vinod Kould927fda2011-01-04 20:16:32 +0530243 substream->runtime->dma_area = substream->dma_buffer.area;
Vinod Kould927fda2011-01-04 20:16:32 +0530244 str_params.sparams = param;
Vinod Koula870cdc2014-06-13 18:03:55 +0530245 str_params.aparams = alloc_params;
246 str_params.codec = SST_CODEC_TYPE_PCM;
247
248 /* fill the device type and stream id to pass to SST driver */
Vinod Koul61b165c2014-06-13 18:03:56 +0530249 ret_val = sst_fill_stream_params(substream, ctx, &str_params, false);
Vinod Kould927fda2011-01-04 20:16:32 +0530250 if (ret_val < 0)
251 return ret_val;
252
Vinod Koula870cdc2014-06-13 18:03:55 +0530253 stream->stream_info.str_id = str_params.stream_id;
254
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530255 ret_val = stream->ops->open(sst->dev, &str_params);
Vinod Koula870cdc2014-06-13 18:03:55 +0530256 if (ret_val <= 0)
257 return ret_val;
258
259
Vinod Kould927fda2011-01-04 20:16:32 +0530260 return ret_val;
261}
262
Vinod Koul9daa5bd2014-06-13 18:03:52 +0530263static void sst_period_elapsed(void *arg)
Vinod Kould927fda2011-01-04 20:16:32 +0530264{
Vinod Koul9daa5bd2014-06-13 18:03:52 +0530265 struct snd_pcm_substream *substream = arg;
Vinod Kould927fda2011-01-04 20:16:32 +0530266 struct sst_runtime_stream *stream;
Harsha Priya5c685362011-01-11 14:50:35 +0530267 int status;
Vinod Kould927fda2011-01-04 20:16:32 +0530268
269 if (!substream || !substream->runtime)
270 return;
271 stream = substream->runtime->private_data;
272 if (!stream)
273 return;
Harsha Priya5c685362011-01-11 14:50:35 +0530274 status = sst_get_stream_status(stream);
275 if (status != SST_PLATFORM_RUNNING)
Vinod Kould927fda2011-01-04 20:16:32 +0530276 return;
Vinod Kould927fda2011-01-04 20:16:32 +0530277 snd_pcm_period_elapsed(substream);
Vinod Kould927fda2011-01-04 20:16:32 +0530278}
279
280static int sst_platform_init_stream(struct snd_pcm_substream *substream)
281{
282 struct sst_runtime_stream *stream =
283 substream->runtime->private_data;
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530284 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Vinod Kould927fda2011-01-04 20:16:32 +0530285 int ret_val;
286
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530287 dev_dbg(rtd->dev, "setting buffer ptr param\n");
Harsha Priya5c685362011-01-11 14:50:35 +0530288 sst_set_stream_status(stream, SST_PLATFORM_INIT);
Vinod Kould927fda2011-01-04 20:16:32 +0530289 stream->stream_info.period_elapsed = sst_period_elapsed;
Vinod Koul9daa5bd2014-06-13 18:03:52 +0530290 stream->stream_info.arg = substream;
Vinod Kould927fda2011-01-04 20:16:32 +0530291 stream->stream_info.buffer_ptr = 0;
292 stream->stream_info.sfreq = substream->runtime->rate;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530293 ret_val = stream->ops->stream_init(sst->dev, &stream->stream_info);
Vinod Kould927fda2011-01-04 20:16:32 +0530294 if (ret_val)
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530295 dev_err(rtd->dev, "control_set ret error %d\n", ret_val);
Vinod Kould927fda2011-01-04 20:16:32 +0530296 return ret_val;
297
298}
Vinod Kould927fda2011-01-04 20:16:32 +0530299
Vinod Koul01213272014-09-19 16:46:03 +0530300static int power_up_sst(struct sst_runtime_stream *stream)
301{
302 return stream->ops->power(sst->dev, true);
303}
304
305static void power_down_sst(struct sst_runtime_stream *stream)
306{
307 stream->ops->power(sst->dev, false);
308}
309
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530310static int sst_media_open(struct snd_pcm_substream *substream,
311 struct snd_soc_dai *dai)
Vinod Kould927fda2011-01-04 20:16:32 +0530312{
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530313 int ret_val = 0;
Lu Guanqun22be5042011-09-06 15:21:38 +0800314 struct snd_pcm_runtime *runtime = substream->runtime;
Vinod Kould927fda2011-01-04 20:16:32 +0530315 struct sst_runtime_stream *stream;
Lu Guanqun22be5042011-09-06 15:21:38 +0800316
Vinod Kould927fda2011-01-04 20:16:32 +0530317 stream = kzalloc(sizeof(*stream), GFP_KERNEL);
318 if (!stream)
319 return -ENOMEM;
Vinod Kould927fda2011-01-04 20:16:32 +0530320 spin_lock_init(&stream->status_lock);
Vinod Koul03c33042011-12-05 19:13:41 +0530321
322 /* get the sst ops */
323 mutex_lock(&sst_lock);
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530324 if (!sst ||
325 !try_module_get(sst->dev->driver->owner)) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530326 dev_err(dai->dev, "no device available to run\n");
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530327 ret_val = -ENODEV;
328 goto out_ops;
Vinod Koul03c33042011-12-05 19:13:41 +0530329 }
330 stream->ops = sst->ops;
331 mutex_unlock(&sst_lock);
332
Vinod Kould927fda2011-01-04 20:16:32 +0530333 stream->stream_info.str_id = 0;
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530334
Vinod Koul9daa5bd2014-06-13 18:03:52 +0530335 stream->stream_info.arg = substream;
Vinod Kould927fda2011-01-04 20:16:32 +0530336 /* allocate memory for SST API set */
Vinod Kould927fda2011-01-04 20:16:32 +0530337 runtime->private_data = stream;
Lu Guanqun283e42e2011-09-06 15:21:43 +0800338
Vinod Koul01213272014-09-19 16:46:03 +0530339 ret_val = power_up_sst(stream);
340 if (ret_val < 0)
341 return ret_val;
342
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530343 /* Make sure, that the period size is always even */
344 snd_pcm_hw_constraint_step(substream->runtime, 0,
345 SNDRV_PCM_HW_PARAM_PERIODS, 2);
346
347 return snd_pcm_hw_constraint_integer(runtime,
348 SNDRV_PCM_HW_PARAM_PERIODS);
349out_ops:
350 kfree(stream);
351 mutex_unlock(&sst_lock);
352 return ret_val;
Vinod Kould927fda2011-01-04 20:16:32 +0530353}
354
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530355static void sst_media_close(struct snd_pcm_substream *substream,
356 struct snd_soc_dai *dai)
Vinod Kould927fda2011-01-04 20:16:32 +0530357{
358 struct sst_runtime_stream *stream;
359 int ret_val = 0, str_id;
360
Vinod Kould927fda2011-01-04 20:16:32 +0530361 stream = substream->runtime->private_data;
Vinod Koul01213272014-09-19 16:46:03 +0530362 power_down_sst(stream);
363
Vinod Kould927fda2011-01-04 20:16:32 +0530364 str_id = stream->stream_info.str_id;
Vinod Kould927fda2011-01-04 20:16:32 +0530365 if (str_id)
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530366 ret_val = stream->ops->close(sst->dev, str_id);
Vinod Koul03c33042011-12-05 19:13:41 +0530367 module_put(sst->dev->driver->owner);
Vinod Kould927fda2011-01-04 20:16:32 +0530368 kfree(stream);
Vinod Koul61b165c2014-06-13 18:03:56 +0530369}
370
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530371static inline unsigned int get_current_pipe_id(struct snd_soc_dai *dai,
Vinod Koul61b165c2014-06-13 18:03:56 +0530372 struct snd_pcm_substream *substream)
373{
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530374 struct sst_data *sst = snd_soc_dai_get_drvdata(dai);
Vinod Koul61b165c2014-06-13 18:03:56 +0530375 struct sst_dev_stream_map *map = sst->pdata->pdev_strm_map;
376 struct sst_runtime_stream *stream =
377 substream->runtime->private_data;
378 u32 str_id = stream->stream_info.str_id;
379 unsigned int pipe_id;
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530380
Vinod Koul61b165c2014-06-13 18:03:56 +0530381 pipe_id = map[str_id].device_id;
382
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530383 dev_dbg(dai->dev, "got pipe_id = %#x for str_id = %d\n",
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530384 pipe_id, str_id);
Vinod Koul61b165c2014-06-13 18:03:56 +0530385 return pipe_id;
Vinod Kould927fda2011-01-04 20:16:32 +0530386}
387
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530388static int sst_media_prepare(struct snd_pcm_substream *substream,
389 struct snd_soc_dai *dai)
Vinod Kould927fda2011-01-04 20:16:32 +0530390{
391 struct sst_runtime_stream *stream;
392 int ret_val = 0, str_id;
393
Vinod Kould927fda2011-01-04 20:16:32 +0530394 stream = substream->runtime->private_data;
395 str_id = stream->stream_info.str_id;
396 if (stream->stream_info.str_id) {
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530397 ret_val = stream->ops->stream_drop(sst->dev, str_id);
Vinod Kould927fda2011-01-04 20:16:32 +0530398 return ret_val;
399 }
400
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530401 ret_val = sst_platform_alloc_stream(substream, dai);
Vinod Koula870cdc2014-06-13 18:03:55 +0530402 if (ret_val <= 0)
Vinod Kould927fda2011-01-04 20:16:32 +0530403 return ret_val;
404 snprintf(substream->pcm->id, sizeof(substream->pcm->id),
405 "%d", stream->stream_info.str_id);
406
407 ret_val = sst_platform_init_stream(substream);
408 if (ret_val)
409 return ret_val;
410 substream->runtime->hw.info = SNDRV_PCM_INFO_BLOCK_TRANSFER;
411 return ret_val;
412}
413
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530414static int sst_media_hw_params(struct snd_pcm_substream *substream,
415 struct snd_pcm_hw_params *params,
416 struct snd_soc_dai *dai)
417{
418 snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
419 memset(substream->runtime->dma_area, 0, params_buffer_bytes(params));
420 return 0;
421}
422
423static int sst_media_hw_free(struct snd_pcm_substream *substream,
424 struct snd_soc_dai *dai)
425{
426 return snd_pcm_lib_free_pages(substream);
427}
428
Vinod Koulc82351d2014-10-15 20:12:59 +0530429static int sst_enable_ssp(struct snd_pcm_substream *substream,
430 struct snd_soc_dai *dai)
431{
432 int ret = 0;
433
434 if (!dai->active) {
435 ret = sst_handle_vb_timer(dai, true);
Vinod Koul711bc942015-05-06 22:06:42 +0530436 sst_fill_ssp_defaults(dai);
Vinod Koulc82351d2014-10-15 20:12:59 +0530437 }
438 return ret;
439}
440
Vinod Koul711bc942015-05-06 22:06:42 +0530441static int sst_be_hw_params(struct snd_pcm_substream *substream,
442 struct snd_pcm_hw_params *params,
443 struct snd_soc_dai *dai)
444{
445 int ret = 0;
446
447 if (dai->active == 1)
448 ret = send_ssp_cmd(dai, dai->name, 1);
449 return ret;
450}
451
Vinod Koul0b44e342015-05-06 22:06:43 +0530452static int sst_set_format(struct snd_soc_dai *dai, unsigned int fmt)
453{
454 int ret = 0;
455
456 if (!dai->active)
457 return 0;
458
459 ret = sst_fill_ssp_config(dai, fmt);
460 if (ret < 0)
461 dev_err(dai->dev, "sst_set_format failed..\n");
462
463 return ret;
464}
465
Vinod Koul83f125e2015-05-06 22:06:44 +0530466static int sst_platform_set_ssp_slot(struct snd_soc_dai *dai,
467 unsigned int tx_mask, unsigned int rx_mask,
468 int slots, int slot_width) {
469 int ret = 0;
470
471 if (!dai->active)
472 return ret;
473
474 ret = sst_fill_ssp_slot(dai, tx_mask, rx_mask, slots, slot_width);
475 if (ret < 0)
476 dev_err(dai->dev, "sst_fill_ssp_slot failed..%d\n", ret);
477
478 return ret;
479}
480
Vinod Koulc82351d2014-10-15 20:12:59 +0530481static void sst_disable_ssp(struct snd_pcm_substream *substream,
482 struct snd_soc_dai *dai)
483{
484 if (!dai->active) {
485 send_ssp_cmd(dai, dai->name, 0);
486 sst_handle_vb_timer(dai, false);
487 }
488}
489
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530490static struct snd_soc_dai_ops sst_media_dai_ops = {
491 .startup = sst_media_open,
492 .shutdown = sst_media_close,
493 .prepare = sst_media_prepare,
494 .hw_params = sst_media_hw_params,
495 .hw_free = sst_media_hw_free,
Vinod Koulc82351d2014-10-15 20:12:59 +0530496 .mute_stream = sst_media_digital_mute,
497};
498
499static struct snd_soc_dai_ops sst_compr_dai_ops = {
500 .mute_stream = sst_media_digital_mute,
501};
502
503static struct snd_soc_dai_ops sst_be_dai_ops = {
504 .startup = sst_enable_ssp,
Vinod Koul711bc942015-05-06 22:06:42 +0530505 .hw_params = sst_be_hw_params,
Vinod Koul0b44e342015-05-06 22:06:43 +0530506 .set_fmt = sst_set_format,
Vinod Koul83f125e2015-05-06 22:06:44 +0530507 .set_tdm_slot = sst_platform_set_ssp_slot,
Vinod Koulc82351d2014-10-15 20:12:59 +0530508 .shutdown = sst_disable_ssp,
509};
510
511static struct snd_soc_dai_driver sst_platform_dai[] = {
512{
513 .name = "media-cpu-dai",
514 .ops = &sst_media_dai_ops,
515 .playback = {
516 .stream_name = "Headset Playback",
517 .channels_min = SST_STEREO,
518 .channels_max = SST_STEREO,
519 .rates = SNDRV_PCM_RATE_44100|SNDRV_PCM_RATE_48000,
520 .formats = SNDRV_PCM_FMTBIT_S16_LE,
521 },
522 .capture = {
523 .stream_name = "Headset Capture",
524 .channels_min = 1,
525 .channels_max = 2,
526 .rates = SNDRV_PCM_RATE_44100|SNDRV_PCM_RATE_48000,
527 .formats = SNDRV_PCM_FMTBIT_S16_LE,
528 },
529},
530{
531 .name = "compress-cpu-dai",
Jie Yang6f0c4222015-10-13 23:41:00 +0800532 .compress_new = snd_soc_new_compress,
Vinod Koulc82351d2014-10-15 20:12:59 +0530533 .ops = &sst_compr_dai_ops,
534 .playback = {
535 .stream_name = "Compress Playback",
536 .channels_min = SST_STEREO,
537 .channels_max = SST_STEREO,
538 .rates = SNDRV_PCM_RATE_48000,
539 .formats = SNDRV_PCM_FMTBIT_S16_LE,
540 },
541},
542/* BE CPU Dais */
543{
544 .name = "ssp0-port",
545 .ops = &sst_be_dai_ops,
546 .playback = {
547 .stream_name = "ssp0 Tx",
548 .channels_min = SST_STEREO,
549 .channels_max = SST_STEREO,
550 .rates = SNDRV_PCM_RATE_48000,
551 .formats = SNDRV_PCM_FMTBIT_S16_LE,
552 },
553 .capture = {
554 .stream_name = "ssp0 Rx",
555 .channels_min = SST_STEREO,
556 .channels_max = SST_STEREO,
557 .rates = SNDRV_PCM_RATE_48000,
558 .formats = SNDRV_PCM_FMTBIT_S16_LE,
559 },
560},
561{
562 .name = "ssp1-port",
563 .ops = &sst_be_dai_ops,
564 .playback = {
565 .stream_name = "ssp1 Tx",
566 .channels_min = SST_STEREO,
567 .channels_max = SST_STEREO,
568 .rates = SNDRV_PCM_RATE_8000|SNDRV_PCM_RATE_16000|SNDRV_PCM_RATE_48000,
569 .formats = SNDRV_PCM_FMTBIT_S16_LE,
570 },
571 .capture = {
572 .stream_name = "ssp1 Rx",
573 .channels_min = SST_STEREO,
574 .channels_max = SST_STEREO,
575 .rates = SNDRV_PCM_RATE_8000|SNDRV_PCM_RATE_16000|SNDRV_PCM_RATE_48000,
576 .formats = SNDRV_PCM_FMTBIT_S16_LE,
577 },
578},
579{
580 .name = "ssp2-port",
581 .ops = &sst_be_dai_ops,
582 .playback = {
583 .stream_name = "ssp2 Tx",
584 .channels_min = SST_STEREO,
585 .channels_max = SST_STEREO,
586 .rates = SNDRV_PCM_RATE_48000,
587 .formats = SNDRV_PCM_FMTBIT_S16_LE,
588 },
589 .capture = {
590 .stream_name = "ssp2 Rx",
591 .channels_min = SST_STEREO,
592 .channels_max = SST_STEREO,
593 .rates = SNDRV_PCM_RATE_48000,
594 .formats = SNDRV_PCM_FMTBIT_S16_LE,
595 },
596},
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530597};
598
599static int sst_platform_open(struct snd_pcm_substream *substream)
600{
601 struct snd_pcm_runtime *runtime;
602
603 if (substream->pcm->internal)
604 return 0;
605
606 runtime = substream->runtime;
607 runtime->hw = sst_platform_pcm_hw;
608 return 0;
609}
610
Vinod Koul5106f5a2014-05-15 21:38:15 +0530611static int sst_platform_pcm_trigger(struct snd_pcm_substream *substream,
Vinod Kould927fda2011-01-04 20:16:32 +0530612 int cmd)
613{
614 int ret_val = 0, str_id;
615 struct sst_runtime_stream *stream;
Subhransu S. Prusty5981c2d2014-08-04 15:04:20 +0530616 int status;
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530617 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Vinod Kould927fda2011-01-04 20:16:32 +0530618
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530619 dev_dbg(rtd->dev, "sst_platform_pcm_trigger called\n");
Vinod Kould2b16b82014-09-09 15:11:24 +0530620 if (substream->pcm->internal)
621 return 0;
Vinod Kould927fda2011-01-04 20:16:32 +0530622 stream = substream->runtime->private_data;
Vinod Kould927fda2011-01-04 20:16:32 +0530623 str_id = stream->stream_info.str_id;
Vinod Kould927fda2011-01-04 20:16:32 +0530624 switch (cmd) {
625 case SNDRV_PCM_TRIGGER_START:
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530626 dev_dbg(rtd->dev, "sst: Trigger Start\n");
Harsha Priyaa2117012011-01-11 14:50:59 +0530627 status = SST_PLATFORM_RUNNING;
Vinod Koul9daa5bd2014-06-13 18:03:52 +0530628 stream->stream_info.arg = substream;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530629 ret_val = stream->ops->stream_start(sst->dev, str_id);
Vinod Kould927fda2011-01-04 20:16:32 +0530630 break;
631 case SNDRV_PCM_TRIGGER_STOP:
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530632 dev_dbg(rtd->dev, "sst: in stop\n");
Harsha Priyaa2117012011-01-11 14:50:59 +0530633 status = SST_PLATFORM_DROPPED;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530634 ret_val = stream->ops->stream_drop(sst->dev, str_id);
Vinod Kould927fda2011-01-04 20:16:32 +0530635 break;
636 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
Vinod Koulfc9406a2015-02-12 09:59:57 +0530637 case SNDRV_PCM_TRIGGER_SUSPEND:
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530638 dev_dbg(rtd->dev, "sst: in pause\n");
Harsha Priyaa2117012011-01-11 14:50:59 +0530639 status = SST_PLATFORM_PAUSED;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530640 ret_val = stream->ops->stream_pause(sst->dev, str_id);
Vinod Kould927fda2011-01-04 20:16:32 +0530641 break;
642 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
Vinod Koulfc9406a2015-02-12 09:59:57 +0530643 case SNDRV_PCM_TRIGGER_RESUME:
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530644 dev_dbg(rtd->dev, "sst: in pause release\n");
Harsha Priyaa2117012011-01-11 14:50:59 +0530645 status = SST_PLATFORM_RUNNING;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530646 ret_val = stream->ops->stream_pause_release(sst->dev, str_id);
Vinod Kould927fda2011-01-04 20:16:32 +0530647 break;
648 default:
Harsha Priyaa2117012011-01-11 14:50:59 +0530649 return -EINVAL;
Vinod Kould927fda2011-01-04 20:16:32 +0530650 }
Subhransu S. Prusty5981c2d2014-08-04 15:04:20 +0530651
Harsha Priyaa2117012011-01-11 14:50:59 +0530652 if (!ret_val)
653 sst_set_stream_status(stream, status);
654
Vinod Kould927fda2011-01-04 20:16:32 +0530655 return ret_val;
656}
657
658
Vinod Koul5106f5a2014-05-15 21:38:15 +0530659static snd_pcm_uframes_t sst_platform_pcm_pointer
Vinod Kould927fda2011-01-04 20:16:32 +0530660 (struct snd_pcm_substream *substream)
661{
662 struct sst_runtime_stream *stream;
Harsha Priya5c685362011-01-11 14:50:35 +0530663 int ret_val, status;
Vinod Kould927fda2011-01-04 20:16:32 +0530664 struct pcm_stream_info *str_info;
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530665 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Vinod Kould927fda2011-01-04 20:16:32 +0530666
Vinod Kould927fda2011-01-04 20:16:32 +0530667 stream = substream->runtime->private_data;
Harsha Priya5c685362011-01-11 14:50:35 +0530668 status = sst_get_stream_status(stream);
669 if (status == SST_PLATFORM_INIT)
Vinod Kould927fda2011-01-04 20:16:32 +0530670 return 0;
Vinod Kould927fda2011-01-04 20:16:32 +0530671 str_info = &stream->stream_info;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530672 ret_val = stream->ops->stream_read_tstamp(sst->dev, str_info);
Vinod Kould927fda2011-01-04 20:16:32 +0530673 if (ret_val) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530674 dev_err(rtd->dev, "sst: error code = %d\n", ret_val);
Vinod Kould927fda2011-01-04 20:16:32 +0530675 return ret_val;
676 }
Vinod Koul2a635822014-06-13 18:03:53 +0530677 substream->runtime->delay = str_info->pcm_delay;
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530678 return str_info->buffer_ptr;
xingchao9ab88432011-04-27 16:58:54 -0400679}
680
Vinod Kould927fda2011-01-04 20:16:32 +0530681static struct snd_pcm_ops sst_platform_ops = {
Vinod Koul5106f5a2014-05-15 21:38:15 +0530682 .open = sst_platform_open,
Vinod Kould927fda2011-01-04 20:16:32 +0530683 .ioctl = snd_pcm_lib_ioctl,
Vinod Koul5106f5a2014-05-15 21:38:15 +0530684 .trigger = sst_platform_pcm_trigger,
685 .pointer = sst_platform_pcm_pointer,
Vinod Kould927fda2011-01-04 20:16:32 +0530686};
687
Axel Lin8faa8c12011-12-13 17:13:45 +0800688static int sst_pcm_new(struct snd_soc_pcm_runtime *rtd)
Vinod Kould927fda2011-01-04 20:16:32 +0530689{
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530690 struct snd_soc_dai *dai = rtd->cpu_dai;
Liam Girdwood552d1ef2011-06-07 16:08:33 +0100691 struct snd_pcm *pcm = rtd->pcm;
Vinod Kould927fda2011-01-04 20:16:32 +0530692 int retval = 0;
693
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530694 if (dai->driver->playback.channels_min ||
695 dai->driver->capture.channels_min) {
Vinod Kould927fda2011-01-04 20:16:32 +0530696 retval = snd_pcm_lib_preallocate_pages_for_all(pcm,
697 SNDRV_DMA_TYPE_CONTINUOUS,
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530698 snd_dma_continuous_data(GFP_DMA),
Vinod Kould927fda2011-01-04 20:16:32 +0530699 SST_MIN_BUFFER, SST_MAX_BUFFER);
700 if (retval) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530701 dev_err(rtd->dev, "dma buffer allocationf fail\n");
Vinod Kould927fda2011-01-04 20:16:32 +0530702 return retval;
703 }
704 }
Vinod Kould927fda2011-01-04 20:16:32 +0530705 return retval;
706}
Vinod Koulc514a912012-08-16 17:10:42 +0530707
Vinod Kould8499c92014-08-04 15:15:55 +0530708static int sst_soc_probe(struct snd_soc_platform *platform)
709{
Vinod Koul54e6bec2015-02-12 09:59:58 +0530710 struct sst_data *drv = dev_get_drvdata(platform->dev);
711
712 drv->soc_card = platform->component.card;
Vinod Kould8499c92014-08-04 15:15:55 +0530713 return sst_dsp_init_v2_dpcm(platform);
714}
715
716static struct snd_soc_platform_driver sst_soc_platform_drv = {
717 .probe = sst_soc_probe,
Vinod Kould927fda2011-01-04 20:16:32 +0530718 .ops = &sst_platform_ops,
Vinod Koulc514a912012-08-16 17:10:42 +0530719 .compr_ops = &sst_platform_compr_ops,
Vinod Kould927fda2011-01-04 20:16:32 +0530720 .pcm_new = sst_pcm_new,
Vinod Kould927fda2011-01-04 20:16:32 +0530721};
722
Vinod Koul2b4c78d2014-05-05 22:19:25 +0530723static const struct snd_soc_component_driver sst_component = {
724 .name = "sst",
725};
726
727
Vinod Kould927fda2011-01-04 20:16:32 +0530728static int sst_platform_probe(struct platform_device *pdev)
729{
Vinod Koul61b165c2014-06-13 18:03:56 +0530730 struct sst_data *drv;
Vinod Kould927fda2011-01-04 20:16:32 +0530731 int ret;
Subhransu S. Prusty2741d432014-07-30 18:39:05 +0530732 struct sst_platform_data *pdata;
Vinod Kould927fda2011-01-04 20:16:32 +0530733
Vinod Koul61b165c2014-06-13 18:03:56 +0530734 drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL);
Subhransu S. Prusty19a23a52014-07-30 18:36:00 +0530735 if (drv == NULL) {
Vinod Koul61b165c2014-06-13 18:03:56 +0530736 return -ENOMEM;
737 }
738
Subhransu S. Prusty2741d432014-07-30 18:39:05 +0530739 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
740 if (pdata == NULL) {
Subhransu S. Prusty2741d432014-07-30 18:39:05 +0530741 return -ENOMEM;
742 }
743
Vinod Koul61b165c2014-06-13 18:03:56 +0530744 pdata->pdev_strm_map = dpcm_strm_map;
745 pdata->strm_map_size = ARRAY_SIZE(dpcm_strm_map);
746 drv->pdata = pdata;
Subhransu S. Prusty3172fcd2014-10-30 16:21:44 +0530747 drv->pdev = pdev;
Vinod Koul61b165c2014-06-13 18:03:56 +0530748 mutex_init(&drv->lock);
749 dev_set_drvdata(&pdev->dev, drv);
750
Vinod Kould927fda2011-01-04 20:16:32 +0530751 ret = snd_soc_register_platform(&pdev->dev, &sst_soc_platform_drv);
752 if (ret) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530753 dev_err(&pdev->dev, "registering soc platform failed\n");
Vinod Kould927fda2011-01-04 20:16:32 +0530754 return ret;
755 }
Harsha Priya5c685362011-01-11 14:50:35 +0530756
Kuninori Morimotob1c36862013-03-21 03:32:50 -0700757 ret = snd_soc_register_component(&pdev->dev, &sst_component,
Vinod Kould927fda2011-01-04 20:16:32 +0530758 sst_platform_dai, ARRAY_SIZE(sst_platform_dai));
759 if (ret) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530760 dev_err(&pdev->dev, "registering cpu dais failed\n");
Vinod Kould927fda2011-01-04 20:16:32 +0530761 snd_soc_unregister_platform(&pdev->dev);
762 }
763 return ret;
764}
765
766static int sst_platform_remove(struct platform_device *pdev)
767{
768
Kuninori Morimotob1c36862013-03-21 03:32:50 -0700769 snd_soc_unregister_component(&pdev->dev);
Vinod Kould927fda2011-01-04 20:16:32 +0530770 snd_soc_unregister_platform(&pdev->dev);
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530771 dev_dbg(&pdev->dev, "sst_platform_remove success\n");
Vinod Kould927fda2011-01-04 20:16:32 +0530772 return 0;
773}
774
Vinod Koul54e6bec2015-02-12 09:59:58 +0530775#ifdef CONFIG_PM_SLEEP
776
777static int sst_soc_prepare(struct device *dev)
778{
779 struct sst_data *drv = dev_get_drvdata(dev);
780 int i;
781
782 /* suspend all pcms first */
783 snd_soc_suspend(drv->soc_card->dev);
784 snd_soc_poweroff(drv->soc_card->dev);
785
786 /* set the SSPs to idle */
787 for (i = 0; i < drv->soc_card->num_rtd; i++) {
788 struct snd_soc_dai *dai = drv->soc_card->rtd[i].cpu_dai;
789
790 if (dai->active) {
791 send_ssp_cmd(dai, dai->name, 0);
792 sst_handle_vb_timer(dai, false);
793 }
794 }
795
796 return 0;
797}
798
799static void sst_soc_complete(struct device *dev)
800{
801 struct sst_data *drv = dev_get_drvdata(dev);
802 int i;
803
804 /* restart SSPs */
805 for (i = 0; i < drv->soc_card->num_rtd; i++) {
806 struct snd_soc_dai *dai = drv->soc_card->rtd[i].cpu_dai;
807
808 if (dai->active) {
809 sst_handle_vb_timer(dai, true);
810 send_ssp_cmd(dai, dai->name, 1);
811 }
812 }
813 snd_soc_resume(drv->soc_card->dev);
814}
815
816#else
817
818#define sst_soc_prepare NULL
819#define sst_soc_complete NULL
820
821#endif
822
823
824static const struct dev_pm_ops sst_platform_pm = {
825 .prepare = sst_soc_prepare,
826 .complete = sst_soc_complete,
827};
828
Vinod Kould927fda2011-01-04 20:16:32 +0530829static struct platform_driver sst_platform_driver = {
830 .driver = {
Mark Browna4b12992014-03-12 23:04:35 +0000831 .name = "sst-mfld-platform",
Vinod Koul54e6bec2015-02-12 09:59:58 +0530832 .pm = &sst_platform_pm,
Vinod Kould927fda2011-01-04 20:16:32 +0530833 },
834 .probe = sst_platform_probe,
835 .remove = sst_platform_remove,
836};
837
Axel Lin29515d62011-11-24 11:51:56 +0800838module_platform_driver(sst_platform_driver);
Vinod Kould927fda2011-01-04 20:16:32 +0530839
840MODULE_DESCRIPTION("ASoC Intel(R) MID Platform driver");
841MODULE_AUTHOR("Vinod Koul <vinod.koul@intel.com>");
842MODULE_AUTHOR("Harsha Priya <priya.harsha@intel.com>");
843MODULE_LICENSE("GPL v2");
Mark Browna4b12992014-03-12 23:04:35 +0000844MODULE_ALIAS("platform:sst-mfld-platform");