1 /*
2 * sst_mfld_platform.c - Intel MID Platform driver
3 *
4 * Copyright (C) 2010-2014 Intel Corp
5 * 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 *
18 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
19 */
20 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
21
22 #include <linux/slab.h>
23 #include <linux/io.h>
24 #include <linux/module.h>
25 #include <sound/core.h>
26 #include <sound/pcm.h>
27 #include <sound/pcm_params.h>
28 #include <sound/soc.h>
29 #include <sound/compress_driver.h>
30 #include <asm/platform_sst_audio.h>
31 #include "sst-mfld-platform.h"
32 #include "sst-atom-controls.h"
33
34 struct sst_device *sst;
35 static DEFINE_MUTEX(sst_lock);
36
sst_register_dsp(struct sst_device * dev)37 int sst_register_dsp(struct sst_device *dev)
38 {
39 if (WARN_ON(!dev))
40 return -EINVAL;
41 if (!try_module_get(dev->dev->driver->owner))
42 return -ENODEV;
43 mutex_lock(&sst_lock);
44 if (sst) {
45 dev_err(dev->dev, "we already have a device %s\n", sst->name);
46 module_put(dev->dev->driver->owner);
47 mutex_unlock(&sst_lock);
48 return -EEXIST;
49 }
50 dev_dbg(dev->dev, "registering device %s\n", dev->name);
51 sst = dev;
52 mutex_unlock(&sst_lock);
53 return 0;
54 }
55 EXPORT_SYMBOL_GPL(sst_register_dsp);
56
sst_unregister_dsp(struct sst_device * dev)57 int sst_unregister_dsp(struct sst_device *dev)
58 {
59 if (WARN_ON(!dev))
60 return -EINVAL;
61 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);
72 dev_dbg(dev->dev, "unreg %s\n", sst->name);
73 sst = NULL;
74 mutex_unlock(&sst_lock);
75 return 0;
76 }
77 EXPORT_SYMBOL_GPL(sst_unregister_dsp);
78
79 static const 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),
88 .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
96 static 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 {MERR_DPCM_DEEP_BUFFER, 0, SNDRV_PCM_STREAM_PLAYBACK, PIPE_MEDIA3_IN, SST_TASK_ID_MEDIA, 0},
102 };
103
sst_media_digital_mute(struct snd_soc_dai * dai,int mute,int stream)104 static int sst_media_digital_mute(struct snd_soc_dai *dai, int mute, int stream)
105 {
106
107 return sst_send_pipe_gains(dai, stream, mute);
108 }
109
110 /* helper functions */
sst_set_stream_status(struct sst_runtime_stream * stream,int state)111 void sst_set_stream_status(struct sst_runtime_stream *stream,
112 int state)
113 {
114 unsigned long flags;
115 spin_lock_irqsave(&stream->status_lock, flags);
116 stream->stream_status = state;
117 spin_unlock_irqrestore(&stream->status_lock, flags);
118 }
119
sst_get_stream_status(struct sst_runtime_stream * stream)120 static inline int sst_get_stream_status(struct sst_runtime_stream *stream)
121 {
122 int state;
123 unsigned long flags;
124
125 spin_lock_irqsave(&stream->status_lock, flags);
126 state = stream->stream_status;
127 spin_unlock_irqrestore(&stream->status_lock, flags);
128 return state;
129 }
130
sst_fill_alloc_params(struct snd_pcm_substream * substream,struct snd_sst_alloc_params_ext * alloc_param)131 static void sst_fill_alloc_params(struct snd_pcm_substream *substream,
132 struct snd_sst_alloc_params_ext *alloc_param)
133 {
134 unsigned int channels;
135 snd_pcm_uframes_t period_size;
136 ssize_t periodbytes;
137 ssize_t buffer_bytes = snd_pcm_lib_buffer_bytes(substream);
138 u32 buffer_addr = virt_to_phys(substream->dma_buffer.area);
139
140 channels = substream->runtime->channels;
141 period_size = substream->runtime->period_size;
142 periodbytes = samples_to_bytes(substream->runtime, period_size);
143 alloc_param->ring_buf_info[0].addr = buffer_addr;
144 alloc_param->ring_buf_info[0].size = buffer_bytes;
145 alloc_param->sg_count = 1;
146 alloc_param->reserved = 0;
147 alloc_param->frag_size = periodbytes * channels;
148
149 }
sst_fill_pcm_params(struct snd_pcm_substream * substream,struct snd_sst_stream_params * param)150 static void sst_fill_pcm_params(struct snd_pcm_substream *substream,
151 struct snd_sst_stream_params *param)
152 {
153 param->uc.pcm_params.num_chan = (u8) substream->runtime->channels;
154 param->uc.pcm_params.pcm_wd_sz = substream->runtime->sample_bits;
155 param->uc.pcm_params.sfreq = substream->runtime->rate;
156
157 /* PCM stream via ALSA interface */
158 param->uc.pcm_params.use_offload_path = 0;
159 param->uc.pcm_params.reserved2 = 0;
160 memset(param->uc.pcm_params.channel_map, 0, sizeof(u8));
161
162 }
163
sst_get_stream_mapping(int dev,int sdev,int dir,struct sst_dev_stream_map * map,int size)164 static int sst_get_stream_mapping(int dev, int sdev, int dir,
165 struct sst_dev_stream_map *map, int size)
166 {
167 int i;
168
169 if (map == NULL)
170 return -EINVAL;
171
172
173 /* index 0 is not used in stream map */
174 for (i = 1; i < size; i++) {
175 if ((map[i].dev_num == dev) && (map[i].direction == dir))
176 return i;
177 }
178 return 0;
179 }
180
sst_fill_stream_params(void * substream,const struct sst_data * ctx,struct snd_sst_params * str_params,bool is_compress)181 int sst_fill_stream_params(void *substream,
182 const struct sst_data *ctx, struct snd_sst_params *str_params, bool is_compress)
183 {
184 int map_size;
185 int index;
186 struct sst_dev_stream_map *map;
187 struct snd_pcm_substream *pstream = NULL;
188 struct snd_compr_stream *cstream = NULL;
189
190 map = ctx->pdata->pdev_strm_map;
191 map_size = ctx->pdata->strm_map_size;
192
193 if (is_compress == true)
194 cstream = (struct snd_compr_stream *)substream;
195 else
196 pstream = (struct snd_pcm_substream *)substream;
197
198 str_params->stream_type = SST_STREAM_TYPE_MUSIC;
199
200 /* For pcm streams */
201 if (pstream) {
202 index = sst_get_stream_mapping(pstream->pcm->device,
203 pstream->number, pstream->stream,
204 map, map_size);
205 if (index <= 0)
206 return -EINVAL;
207
208 str_params->stream_id = index;
209 str_params->device_type = map[index].device_id;
210 str_params->task = map[index].task_id;
211
212 str_params->ops = (u8)pstream->stream;
213 }
214
215 if (cstream) {
216 index = sst_get_stream_mapping(cstream->device->device,
217 0, cstream->direction,
218 map, map_size);
219 if (index <= 0)
220 return -EINVAL;
221 str_params->stream_id = index;
222 str_params->device_type = map[index].device_id;
223 str_params->task = map[index].task_id;
224
225 str_params->ops = (u8)cstream->direction;
226 }
227 return 0;
228 }
229
sst_platform_alloc_stream(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)230 static int sst_platform_alloc_stream(struct snd_pcm_substream *substream,
231 struct snd_soc_dai *dai)
232 {
233 struct sst_runtime_stream *stream =
234 substream->runtime->private_data;
235 struct snd_sst_stream_params param = {{{0,},},};
236 struct snd_sst_params str_params = {0};
237 struct snd_sst_alloc_params_ext alloc_params = {0};
238 int ret_val = 0;
239 struct sst_data *ctx = snd_soc_dai_get_drvdata(dai);
240
241 /* set codec params and inform SST driver the same */
242 sst_fill_pcm_params(substream, ¶m);
243 sst_fill_alloc_params(substream, &alloc_params);
244 substream->runtime->dma_area = substream->dma_buffer.area;
245 str_params.sparams = param;
246 str_params.aparams = alloc_params;
247 str_params.codec = SST_CODEC_TYPE_PCM;
248
249 /* fill the device type and stream id to pass to SST driver */
250 ret_val = sst_fill_stream_params(substream, ctx, &str_params, false);
251 if (ret_val < 0)
252 return ret_val;
253
254 stream->stream_info.str_id = str_params.stream_id;
255
256 ret_val = stream->ops->open(sst->dev, &str_params);
257 if (ret_val <= 0)
258 return ret_val;
259
260
261 return ret_val;
262 }
263
sst_period_elapsed(void * arg)264 static void sst_period_elapsed(void *arg)
265 {
266 struct snd_pcm_substream *substream = arg;
267 struct sst_runtime_stream *stream;
268 int status;
269
270 if (!substream || !substream->runtime)
271 return;
272 stream = substream->runtime->private_data;
273 if (!stream)
274 return;
275 status = sst_get_stream_status(stream);
276 if (status != SST_PLATFORM_RUNNING)
277 return;
278 snd_pcm_period_elapsed(substream);
279 }
280
sst_platform_init_stream(struct snd_pcm_substream * substream)281 static int sst_platform_init_stream(struct snd_pcm_substream *substream)
282 {
283 struct sst_runtime_stream *stream =
284 substream->runtime->private_data;
285 struct snd_soc_pcm_runtime *rtd = substream->private_data;
286 int ret_val;
287
288 dev_dbg(rtd->dev, "setting buffer ptr param\n");
289 sst_set_stream_status(stream, SST_PLATFORM_INIT);
290 stream->stream_info.period_elapsed = sst_period_elapsed;
291 stream->stream_info.arg = substream;
292 stream->stream_info.buffer_ptr = 0;
293 stream->stream_info.sfreq = substream->runtime->rate;
294 ret_val = stream->ops->stream_init(sst->dev, &stream->stream_info);
295 if (ret_val)
296 dev_err(rtd->dev, "control_set ret error %d\n", ret_val);
297 return ret_val;
298
299 }
300
power_up_sst(struct sst_runtime_stream * stream)301 static int power_up_sst(struct sst_runtime_stream *stream)
302 {
303 return stream->ops->power(sst->dev, true);
304 }
305
power_down_sst(struct sst_runtime_stream * stream)306 static void power_down_sst(struct sst_runtime_stream *stream)
307 {
308 stream->ops->power(sst->dev, false);
309 }
310
sst_media_open(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)311 static int sst_media_open(struct snd_pcm_substream *substream,
312 struct snd_soc_dai *dai)
313 {
314 int ret_val = 0;
315 struct snd_pcm_runtime *runtime = substream->runtime;
316 struct sst_runtime_stream *stream;
317
318 stream = kzalloc(sizeof(*stream), GFP_KERNEL);
319 if (!stream)
320 return -ENOMEM;
321 spin_lock_init(&stream->status_lock);
322
323 /* get the sst ops */
324 mutex_lock(&sst_lock);
325 if (!sst ||
326 !try_module_get(sst->dev->driver->owner)) {
327 dev_err(dai->dev, "no device available to run\n");
328 ret_val = -ENODEV;
329 goto out_ops;
330 }
331 stream->ops = sst->ops;
332 mutex_unlock(&sst_lock);
333
334 stream->stream_info.str_id = 0;
335
336 stream->stream_info.arg = substream;
337 /* allocate memory for SST API set */
338 runtime->private_data = stream;
339
340 ret_val = power_up_sst(stream);
341 if (ret_val < 0)
342 return ret_val;
343
344 /* Make sure, that the period size is always even */
345 snd_pcm_hw_constraint_step(substream->runtime, 0,
346 SNDRV_PCM_HW_PARAM_PERIODS, 2);
347
348 return snd_pcm_hw_constraint_integer(runtime,
349 SNDRV_PCM_HW_PARAM_PERIODS);
350 out_ops:
351 kfree(stream);
352 mutex_unlock(&sst_lock);
353 return ret_val;
354 }
355
sst_media_close(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)356 static void sst_media_close(struct snd_pcm_substream *substream,
357 struct snd_soc_dai *dai)
358 {
359 struct sst_runtime_stream *stream;
360 int str_id;
361
362 stream = substream->runtime->private_data;
363 power_down_sst(stream);
364
365 str_id = stream->stream_info.str_id;
366 if (str_id)
367 stream->ops->close(sst->dev, str_id);
368 module_put(sst->dev->driver->owner);
369 kfree(stream);
370 }
371
sst_media_prepare(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)372 static int sst_media_prepare(struct snd_pcm_substream *substream,
373 struct snd_soc_dai *dai)
374 {
375 struct sst_runtime_stream *stream;
376 int ret_val = 0, str_id;
377
378 stream = substream->runtime->private_data;
379 str_id = stream->stream_info.str_id;
380 if (stream->stream_info.str_id) {
381 ret_val = stream->ops->stream_drop(sst->dev, str_id);
382 return ret_val;
383 }
384
385 ret_val = sst_platform_alloc_stream(substream, dai);
386 if (ret_val <= 0)
387 return ret_val;
388 snprintf(substream->pcm->id, sizeof(substream->pcm->id),
389 "%d", stream->stream_info.str_id);
390
391 ret_val = sst_platform_init_stream(substream);
392 if (ret_val)
393 return ret_val;
394 substream->runtime->hw.info = SNDRV_PCM_INFO_BLOCK_TRANSFER;
395 return ret_val;
396 }
397
sst_media_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)398 static int sst_media_hw_params(struct snd_pcm_substream *substream,
399 struct snd_pcm_hw_params *params,
400 struct snd_soc_dai *dai)
401 {
402 snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
403 memset(substream->runtime->dma_area, 0, params_buffer_bytes(params));
404 return 0;
405 }
406
sst_media_hw_free(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)407 static int sst_media_hw_free(struct snd_pcm_substream *substream,
408 struct snd_soc_dai *dai)
409 {
410 return snd_pcm_lib_free_pages(substream);
411 }
412
sst_enable_ssp(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)413 static int sst_enable_ssp(struct snd_pcm_substream *substream,
414 struct snd_soc_dai *dai)
415 {
416 int ret = 0;
417
418 if (!dai->active) {
419 ret = sst_handle_vb_timer(dai, true);
420 sst_fill_ssp_defaults(dai);
421 }
422 return ret;
423 }
424
sst_be_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)425 static int sst_be_hw_params(struct snd_pcm_substream *substream,
426 struct snd_pcm_hw_params *params,
427 struct snd_soc_dai *dai)
428 {
429 int ret = 0;
430
431 if (dai->active == 1)
432 ret = send_ssp_cmd(dai, dai->name, 1);
433 return ret;
434 }
435
sst_set_format(struct snd_soc_dai * dai,unsigned int fmt)436 static int sst_set_format(struct snd_soc_dai *dai, unsigned int fmt)
437 {
438 int ret = 0;
439
440 if (!dai->active)
441 return 0;
442
443 ret = sst_fill_ssp_config(dai, fmt);
444 if (ret < 0)
445 dev_err(dai->dev, "sst_set_format failed..\n");
446
447 return ret;
448 }
449
sst_platform_set_ssp_slot(struct snd_soc_dai * dai,unsigned int tx_mask,unsigned int rx_mask,int slots,int slot_width)450 static int sst_platform_set_ssp_slot(struct snd_soc_dai *dai,
451 unsigned int tx_mask, unsigned int rx_mask,
452 int slots, int slot_width) {
453 int ret = 0;
454
455 if (!dai->active)
456 return ret;
457
458 ret = sst_fill_ssp_slot(dai, tx_mask, rx_mask, slots, slot_width);
459 if (ret < 0)
460 dev_err(dai->dev, "sst_fill_ssp_slot failed..%d\n", ret);
461
462 return ret;
463 }
464
sst_disable_ssp(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)465 static void sst_disable_ssp(struct snd_pcm_substream *substream,
466 struct snd_soc_dai *dai)
467 {
468 if (!dai->active) {
469 send_ssp_cmd(dai, dai->name, 0);
470 sst_handle_vb_timer(dai, false);
471 }
472 }
473
474 static const struct snd_soc_dai_ops sst_media_dai_ops = {
475 .startup = sst_media_open,
476 .shutdown = sst_media_close,
477 .prepare = sst_media_prepare,
478 .hw_params = sst_media_hw_params,
479 .hw_free = sst_media_hw_free,
480 .mute_stream = sst_media_digital_mute,
481 };
482
483 static const struct snd_soc_dai_ops sst_compr_dai_ops = {
484 .mute_stream = sst_media_digital_mute,
485 };
486
487 static const struct snd_soc_dai_ops sst_be_dai_ops = {
488 .startup = sst_enable_ssp,
489 .hw_params = sst_be_hw_params,
490 .set_fmt = sst_set_format,
491 .set_tdm_slot = sst_platform_set_ssp_slot,
492 .shutdown = sst_disable_ssp,
493 };
494
495 static struct snd_soc_dai_driver sst_platform_dai[] = {
496 {
497 .name = "media-cpu-dai",
498 .ops = &sst_media_dai_ops,
499 .playback = {
500 .stream_name = "Headset Playback",
501 .channels_min = SST_STEREO,
502 .channels_max = SST_STEREO,
503 .rates = SNDRV_PCM_RATE_44100|SNDRV_PCM_RATE_48000,
504 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
505 },
506 .capture = {
507 .stream_name = "Headset Capture",
508 .channels_min = 1,
509 .channels_max = 2,
510 .rates = SNDRV_PCM_RATE_44100|SNDRV_PCM_RATE_48000,
511 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
512 },
513 },
514 {
515 .name = "deepbuffer-cpu-dai",
516 .ops = &sst_media_dai_ops,
517 .playback = {
518 .stream_name = "Deepbuffer Playback",
519 .channels_min = SST_STEREO,
520 .channels_max = SST_STEREO,
521 .rates = SNDRV_PCM_RATE_44100|SNDRV_PCM_RATE_48000,
522 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
523 },
524 },
525 {
526 .name = "compress-cpu-dai",
527 .compress_new = snd_soc_new_compress,
528 .ops = &sst_compr_dai_ops,
529 .playback = {
530 .stream_name = "Compress Playback",
531 .channels_min = 1,
532 },
533 },
534 /* BE CPU Dais */
535 {
536 .name = "ssp0-port",
537 .ops = &sst_be_dai_ops,
538 .playback = {
539 .stream_name = "ssp0 Tx",
540 .channels_min = SST_STEREO,
541 .channels_max = SST_STEREO,
542 .rates = SNDRV_PCM_RATE_48000,
543 .formats = SNDRV_PCM_FMTBIT_S16_LE,
544 },
545 .capture = {
546 .stream_name = "ssp0 Rx",
547 .channels_min = SST_STEREO,
548 .channels_max = SST_STEREO,
549 .rates = SNDRV_PCM_RATE_48000,
550 .formats = SNDRV_PCM_FMTBIT_S16_LE,
551 },
552 },
553 {
554 .name = "ssp1-port",
555 .ops = &sst_be_dai_ops,
556 .playback = {
557 .stream_name = "ssp1 Tx",
558 .channels_min = SST_STEREO,
559 .channels_max = SST_STEREO,
560 .rates = SNDRV_PCM_RATE_8000|SNDRV_PCM_RATE_16000|SNDRV_PCM_RATE_48000,
561 .formats = SNDRV_PCM_FMTBIT_S16_LE,
562 },
563 .capture = {
564 .stream_name = "ssp1 Rx",
565 .channels_min = SST_STEREO,
566 .channels_max = SST_STEREO,
567 .rates = SNDRV_PCM_RATE_8000|SNDRV_PCM_RATE_16000|SNDRV_PCM_RATE_48000,
568 .formats = SNDRV_PCM_FMTBIT_S16_LE,
569 },
570 },
571 {
572 .name = "ssp2-port",
573 .ops = &sst_be_dai_ops,
574 .playback = {
575 .stream_name = "ssp2 Tx",
576 .channels_min = SST_STEREO,
577 .channels_max = SST_STEREO,
578 .rates = SNDRV_PCM_RATE_48000,
579 .formats = SNDRV_PCM_FMTBIT_S16_LE,
580 },
581 .capture = {
582 .stream_name = "ssp2 Rx",
583 .channels_min = SST_STEREO,
584 .channels_max = SST_STEREO,
585 .rates = SNDRV_PCM_RATE_48000,
586 .formats = SNDRV_PCM_FMTBIT_S16_LE,
587 },
588 },
589 };
590
sst_platform_open(struct snd_pcm_substream * substream)591 static int sst_platform_open(struct snd_pcm_substream *substream)
592 {
593 struct snd_pcm_runtime *runtime;
594
595 if (substream->pcm->internal)
596 return 0;
597
598 runtime = substream->runtime;
599 runtime->hw = sst_platform_pcm_hw;
600 return 0;
601 }
602
sst_platform_pcm_trigger(struct snd_pcm_substream * substream,int cmd)603 static int sst_platform_pcm_trigger(struct snd_pcm_substream *substream,
604 int cmd)
605 {
606 int ret_val = 0, str_id;
607 struct sst_runtime_stream *stream;
608 int status;
609 struct snd_soc_pcm_runtime *rtd = substream->private_data;
610
611 dev_dbg(rtd->dev, "sst_platform_pcm_trigger called\n");
612 if (substream->pcm->internal)
613 return 0;
614 stream = substream->runtime->private_data;
615 str_id = stream->stream_info.str_id;
616 switch (cmd) {
617 case SNDRV_PCM_TRIGGER_START:
618 dev_dbg(rtd->dev, "sst: Trigger Start\n");
619 status = SST_PLATFORM_RUNNING;
620 stream->stream_info.arg = substream;
621 ret_val = stream->ops->stream_start(sst->dev, str_id);
622 break;
623 case SNDRV_PCM_TRIGGER_STOP:
624 dev_dbg(rtd->dev, "sst: in stop\n");
625 status = SST_PLATFORM_DROPPED;
626 ret_val = stream->ops->stream_drop(sst->dev, str_id);
627 break;
628 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
629 case SNDRV_PCM_TRIGGER_SUSPEND:
630 dev_dbg(rtd->dev, "sst: in pause\n");
631 status = SST_PLATFORM_PAUSED;
632 ret_val = stream->ops->stream_pause(sst->dev, str_id);
633 break;
634 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
635 case SNDRV_PCM_TRIGGER_RESUME:
636 dev_dbg(rtd->dev, "sst: in pause release\n");
637 status = SST_PLATFORM_RUNNING;
638 ret_val = stream->ops->stream_pause_release(sst->dev, str_id);
639 break;
640 default:
641 return -EINVAL;
642 }
643
644 if (!ret_val)
645 sst_set_stream_status(stream, status);
646
647 return ret_val;
648 }
649
650
sst_platform_pcm_pointer(struct snd_pcm_substream * substream)651 static snd_pcm_uframes_t sst_platform_pcm_pointer
652 (struct snd_pcm_substream *substream)
653 {
654 struct sst_runtime_stream *stream;
655 int ret_val, status;
656 struct pcm_stream_info *str_info;
657 struct snd_soc_pcm_runtime *rtd = substream->private_data;
658
659 stream = substream->runtime->private_data;
660 status = sst_get_stream_status(stream);
661 if (status == SST_PLATFORM_INIT)
662 return 0;
663 str_info = &stream->stream_info;
664 ret_val = stream->ops->stream_read_tstamp(sst->dev, str_info);
665 if (ret_val) {
666 dev_err(rtd->dev, "sst: error code = %d\n", ret_val);
667 return ret_val;
668 }
669 substream->runtime->delay = str_info->pcm_delay;
670 return str_info->buffer_ptr;
671 }
672
673 static const struct snd_pcm_ops sst_platform_ops = {
674 .open = sst_platform_open,
675 .ioctl = snd_pcm_lib_ioctl,
676 .trigger = sst_platform_pcm_trigger,
677 .pointer = sst_platform_pcm_pointer,
678 };
679
sst_pcm_new(struct snd_soc_pcm_runtime * rtd)680 static int sst_pcm_new(struct snd_soc_pcm_runtime *rtd)
681 {
682 struct snd_soc_dai *dai = rtd->cpu_dai;
683 struct snd_pcm *pcm = rtd->pcm;
684 int retval = 0;
685
686 if (dai->driver->playback.channels_min ||
687 dai->driver->capture.channels_min) {
688 retval = snd_pcm_lib_preallocate_pages_for_all(pcm,
689 SNDRV_DMA_TYPE_CONTINUOUS,
690 snd_dma_continuous_data(GFP_DMA),
691 SST_MIN_BUFFER, SST_MAX_BUFFER);
692 if (retval) {
693 dev_err(rtd->dev, "dma buffer allocation failure\n");
694 return retval;
695 }
696 }
697 return retval;
698 }
699
sst_soc_probe(struct snd_soc_component * component)700 static int sst_soc_probe(struct snd_soc_component *component)
701 {
702 struct sst_data *drv = dev_get_drvdata(component->dev);
703
704 drv->soc_card = component->card;
705 return sst_dsp_init_v2_dpcm(component);
706 }
707
708 static const struct snd_soc_component_driver sst_soc_platform_drv = {
709 .name = DRV_NAME,
710 .probe = sst_soc_probe,
711 .ops = &sst_platform_ops,
712 .compr_ops = &sst_platform_compr_ops,
713 .pcm_new = sst_pcm_new,
714 };
715
sst_platform_probe(struct platform_device * pdev)716 static int sst_platform_probe(struct platform_device *pdev)
717 {
718 struct sst_data *drv;
719 int ret;
720 struct sst_platform_data *pdata;
721
722 drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL);
723 if (drv == NULL) {
724 return -ENOMEM;
725 }
726
727 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
728 if (pdata == NULL) {
729 return -ENOMEM;
730 }
731
732 pdata->pdev_strm_map = dpcm_strm_map;
733 pdata->strm_map_size = ARRAY_SIZE(dpcm_strm_map);
734 drv->pdata = pdata;
735 drv->pdev = pdev;
736 mutex_init(&drv->lock);
737 dev_set_drvdata(&pdev->dev, drv);
738
739 ret = devm_snd_soc_register_component(&pdev->dev, &sst_soc_platform_drv,
740 sst_platform_dai, ARRAY_SIZE(sst_platform_dai));
741 if (ret)
742 dev_err(&pdev->dev, "registering cpu dais failed\n");
743
744 return ret;
745 }
746
sst_platform_remove(struct platform_device * pdev)747 static int sst_platform_remove(struct platform_device *pdev)
748 {
749 dev_dbg(&pdev->dev, "sst_platform_remove success\n");
750 return 0;
751 }
752
753 #ifdef CONFIG_PM_SLEEP
754
sst_soc_prepare(struct device * dev)755 static int sst_soc_prepare(struct device *dev)
756 {
757 struct sst_data *drv = dev_get_drvdata(dev);
758 struct snd_soc_pcm_runtime *rtd;
759
760 if (!drv->soc_card)
761 return 0;
762
763 /* suspend all pcms first */
764 snd_soc_suspend(drv->soc_card->dev);
765 snd_soc_poweroff(drv->soc_card->dev);
766
767 /* set the SSPs to idle */
768 list_for_each_entry(rtd, &drv->soc_card->rtd_list, list) {
769 struct snd_soc_dai *dai = rtd->cpu_dai;
770
771 if (dai->active) {
772 send_ssp_cmd(dai, dai->name, 0);
773 sst_handle_vb_timer(dai, false);
774 }
775 }
776
777 return 0;
778 }
779
sst_soc_complete(struct device * dev)780 static void sst_soc_complete(struct device *dev)
781 {
782 struct sst_data *drv = dev_get_drvdata(dev);
783 struct snd_soc_pcm_runtime *rtd;
784
785 if (!drv->soc_card)
786 return;
787
788 /* restart SSPs */
789 list_for_each_entry(rtd, &drv->soc_card->rtd_list, list) {
790 struct snd_soc_dai *dai = rtd->cpu_dai;
791
792 if (dai->active) {
793 sst_handle_vb_timer(dai, true);
794 send_ssp_cmd(dai, dai->name, 1);
795 }
796 }
797 snd_soc_resume(drv->soc_card->dev);
798 }
799
800 #else
801
802 #define sst_soc_prepare NULL
803 #define sst_soc_complete NULL
804
805 #endif
806
807
808 static const struct dev_pm_ops sst_platform_pm = {
809 .prepare = sst_soc_prepare,
810 .complete = sst_soc_complete,
811 };
812
813 static struct platform_driver sst_platform_driver = {
814 .driver = {
815 .name = "sst-mfld-platform",
816 .pm = &sst_platform_pm,
817 },
818 .probe = sst_platform_probe,
819 .remove = sst_platform_remove,
820 };
821
822 module_platform_driver(sst_platform_driver);
823
824 MODULE_DESCRIPTION("ASoC Intel(R) MID Platform driver");
825 MODULE_AUTHOR("Vinod Koul <vinod.koul@intel.com>");
826 MODULE_AUTHOR("Harsha Priya <priya.harsha@intel.com>");
827 MODULE_LICENSE("GPL v2");
828 MODULE_ALIAS("platform:sst-atom-hifi2-platform");
829 MODULE_ALIAS("platform:sst-mfld-platform");
830