blob: 641ebe61dc08ba507ffb99c81d7ec0aa2c6d7986 [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);
Vinod Koul4b68b4e2014-05-05 14:27:50 +053036extern struct snd_compr_ops sst_platform_compr_ops;
Vinod Koul03c33042011-12-05 19:13:41 +053037
38int sst_register_dsp(struct sst_device *dev)
39{
Takashi Iwai656a22a2013-11-05 18:40:01 +010040 if (WARN_ON(!dev))
41 return -EINVAL;
Vinod Koul03c33042011-12-05 19:13:41 +053042 if (!try_module_get(dev->dev->driver->owner))
43 return -ENODEV;
44 mutex_lock(&sst_lock);
45 if (sst) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +053046 dev_err(dev->dev, "we already have a device %s\n", sst->name);
Vinod Koul03c33042011-12-05 19:13:41 +053047 module_put(dev->dev->driver->owner);
48 mutex_unlock(&sst_lock);
49 return -EEXIST;
50 }
Subhransu S. Prusty02024752014-09-02 18:05:56 +053051 dev_dbg(dev->dev, "registering device %s\n", dev->name);
Vinod Koul03c33042011-12-05 19:13:41 +053052 sst = dev;
53 mutex_unlock(&sst_lock);
54 return 0;
55}
56EXPORT_SYMBOL_GPL(sst_register_dsp);
57
58int sst_unregister_dsp(struct sst_device *dev)
59{
Takashi Iwai656a22a2013-11-05 18:40:01 +010060 if (WARN_ON(!dev))
61 return -EINVAL;
Vinod Koul03c33042011-12-05 19:13:41 +053062 if (dev != sst)
63 return -EINVAL;
64
65 mutex_lock(&sst_lock);
66
67 if (!sst) {
68 mutex_unlock(&sst_lock);
69 return -EIO;
70 }
71
72 module_put(sst->dev->driver->owner);
Subhransu S. Prusty02024752014-09-02 18:05:56 +053073 dev_dbg(dev->dev, "unreg %s\n", sst->name);
Vinod Koul03c33042011-12-05 19:13:41 +053074 sst = NULL;
75 mutex_unlock(&sst_lock);
76 return 0;
77}
78EXPORT_SYMBOL_GPL(sst_unregister_dsp);
79
Vinod Kould927fda2011-01-04 20:16:32 +053080static struct snd_pcm_hardware sst_platform_pcm_hw = {
81 .info = (SNDRV_PCM_INFO_INTERLEAVED |
82 SNDRV_PCM_INFO_DOUBLE |
83 SNDRV_PCM_INFO_PAUSE |
84 SNDRV_PCM_INFO_RESUME |
85 SNDRV_PCM_INFO_MMAP|
86 SNDRV_PCM_INFO_MMAP_VALID |
87 SNDRV_PCM_INFO_BLOCK_TRANSFER |
88 SNDRV_PCM_INFO_SYNC_START),
Vinod Kould927fda2011-01-04 20:16:32 +053089 .buffer_bytes_max = SST_MAX_BUFFER,
90 .period_bytes_min = SST_MIN_PERIOD_BYTES,
91 .period_bytes_max = SST_MAX_PERIOD_BYTES,
92 .periods_min = SST_MIN_PERIODS,
93 .periods_max = SST_MAX_PERIODS,
94 .fifo_size = SST_FIFO_SIZE,
95};
96
Vinod Koul61b165c2014-06-13 18:03:56 +053097static struct sst_dev_stream_map dpcm_strm_map[] = {
98 {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF}, /* Reserved, not in use */
99 {MERR_DPCM_AUDIO, 0, SNDRV_PCM_STREAM_PLAYBACK, PIPE_MEDIA1_IN, SST_TASK_ID_MEDIA, 0},
100 {MERR_DPCM_COMPR, 0, SNDRV_PCM_STREAM_PLAYBACK, PIPE_MEDIA0_IN, SST_TASK_ID_MEDIA, 0},
101 {MERR_DPCM_AUDIO, 0, SNDRV_PCM_STREAM_CAPTURE, PIPE_PCM1_OUT, SST_TASK_ID_MEDIA, 0},
102};
103
Vinod Koulc82351d2014-10-15 20:12:59 +0530104static int sst_media_digital_mute(struct snd_soc_dai *dai, int mute, int stream)
Vinod Kould927fda2011-01-04 20:16:32 +0530105{
Vinod Koulc82351d2014-10-15 20:12:59 +0530106
107 return sst_send_pipe_gains(dai, stream, mute);
108}
Harsha Priya5c685362011-01-11 14:50:35 +0530109
Vinod Kould927fda2011-01-04 20:16:32 +0530110/* helper functions */
Vinod Koul4496ffa2014-05-05 14:27:49 +0530111void sst_set_stream_status(struct sst_runtime_stream *stream,
Harsha Priya5c685362011-01-11 14:50:35 +0530112 int state)
113{
Lu Guanqund89b0a12011-04-08 15:38:48 +0800114 unsigned long flags;
115 spin_lock_irqsave(&stream->status_lock, flags);
Harsha Priya5c685362011-01-11 14:50:35 +0530116 stream->stream_status = state;
Lu Guanqund89b0a12011-04-08 15:38:48 +0800117 spin_unlock_irqrestore(&stream->status_lock, flags);
Harsha Priya5c685362011-01-11 14:50:35 +0530118}
119
120static inline int sst_get_stream_status(struct sst_runtime_stream *stream)
121{
122 int state;
Lu Guanqund89b0a12011-04-08 15:38:48 +0800123 unsigned long flags;
Harsha Priya5c685362011-01-11 14:50:35 +0530124
Lu Guanqund89b0a12011-04-08 15:38:48 +0800125 spin_lock_irqsave(&stream->status_lock, flags);
Harsha Priya5c685362011-01-11 14:50:35 +0530126 state = stream->stream_status;
Lu Guanqund89b0a12011-04-08 15:38:48 +0800127 spin_unlock_irqrestore(&stream->status_lock, flags);
Harsha Priya5c685362011-01-11 14:50:35 +0530128 return state;
129}
130
Vinod Koula870cdc2014-06-13 18:03:55 +0530131static void sst_fill_alloc_params(struct snd_pcm_substream *substream,
132 struct snd_sst_alloc_params_ext *alloc_param)
Harsha Priya5c685362011-01-11 14:50:35 +0530133{
Vinod Koula870cdc2014-06-13 18:03:55 +0530134 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);
Harsha Priya5c685362011-01-11 14:50:35 +0530139
Vinod Koula870cdc2014-06-13 18:03:55 +0530140 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}
150static 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}
Vinod Koul61b165c2014-06-13 18:03:56 +0530163
164static int sst_get_stream_mapping(int dev, int sdev, int dir,
165 struct sst_dev_stream_map *map, int size)
Vinod Koula870cdc2014-06-13 18:03:55 +0530166{
Vinod Koul61b165c2014-06-13 18:03:56 +0530167 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
181int 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;
Vinod Koula870cdc2014-06-13 18:03:55 +0530187 struct snd_pcm_substream *pstream = NULL;
188 struct snd_compr_stream *cstream = NULL;
189
Vinod Koul61b165c2014-06-13 18:03:56 +0530190 map = ctx->pdata->pdev_strm_map;
191 map_size = ctx->pdata->strm_map_size;
192
Vinod Koula870cdc2014-06-13 18:03:55 +0530193 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 */
Vinod Koul61b165c2014-06-13 18:03:56 +0530201 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;
Vinod Koula870cdc2014-06-13 18:03:55 +0530207
Vinod Koul61b165c2014-06-13 18:03:56 +0530208 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 }
Vinod Koula870cdc2014-06-13 18:03:55 +0530227 return 0;
Harsha Priya5c685362011-01-11 14:50:35 +0530228}
229
Vinod Koula870cdc2014-06-13 18:03:55 +0530230static int sst_platform_alloc_stream(struct snd_pcm_substream *substream,
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530231 struct snd_soc_dai *dai)
Vinod Kould927fda2011-01-04 20:16:32 +0530232{
233 struct sst_runtime_stream *stream =
234 substream->runtime->private_data;
Vinod Koula870cdc2014-06-13 18:03:55 +0530235 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;
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530239 struct sst_data *ctx = snd_soc_dai_get_drvdata(dai);
Vinod Kould927fda2011-01-04 20:16:32 +0530240
241 /* set codec params and inform SST driver the same */
Harsha Priya5c685362011-01-11 14:50:35 +0530242 sst_fill_pcm_params(substream, &param);
Vinod Koula870cdc2014-06-13 18:03:55 +0530243 sst_fill_alloc_params(substream, &alloc_params);
Vinod Kould927fda2011-01-04 20:16:32 +0530244 substream->runtime->dma_area = substream->dma_buffer.area;
Vinod Kould927fda2011-01-04 20:16:32 +0530245 str_params.sparams = param;
Vinod Koula870cdc2014-06-13 18:03:55 +0530246 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 */
Vinod Koul61b165c2014-06-13 18:03:56 +0530250 ret_val = sst_fill_stream_params(substream, ctx, &str_params, false);
Vinod Kould927fda2011-01-04 20:16:32 +0530251 if (ret_val < 0)
252 return ret_val;
253
Vinod Koula870cdc2014-06-13 18:03:55 +0530254 stream->stream_info.str_id = str_params.stream_id;
255
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530256 ret_val = stream->ops->open(sst->dev, &str_params);
Vinod Koula870cdc2014-06-13 18:03:55 +0530257 if (ret_val <= 0)
258 return ret_val;
259
260
Vinod Kould927fda2011-01-04 20:16:32 +0530261 return ret_val;
262}
263
Vinod Koul9daa5bd2014-06-13 18:03:52 +0530264static void sst_period_elapsed(void *arg)
Vinod Kould927fda2011-01-04 20:16:32 +0530265{
Vinod Koul9daa5bd2014-06-13 18:03:52 +0530266 struct snd_pcm_substream *substream = arg;
Vinod Kould927fda2011-01-04 20:16:32 +0530267 struct sst_runtime_stream *stream;
Harsha Priya5c685362011-01-11 14:50:35 +0530268 int status;
Vinod Kould927fda2011-01-04 20:16:32 +0530269
270 if (!substream || !substream->runtime)
271 return;
272 stream = substream->runtime->private_data;
273 if (!stream)
274 return;
Harsha Priya5c685362011-01-11 14:50:35 +0530275 status = sst_get_stream_status(stream);
276 if (status != SST_PLATFORM_RUNNING)
Vinod Kould927fda2011-01-04 20:16:32 +0530277 return;
Vinod Kould927fda2011-01-04 20:16:32 +0530278 snd_pcm_period_elapsed(substream);
Vinod Kould927fda2011-01-04 20:16:32 +0530279}
280
281static int sst_platform_init_stream(struct snd_pcm_substream *substream)
282{
283 struct sst_runtime_stream *stream =
284 substream->runtime->private_data;
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530285 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Vinod Kould927fda2011-01-04 20:16:32 +0530286 int ret_val;
287
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530288 dev_dbg(rtd->dev, "setting buffer ptr param\n");
Harsha Priya5c685362011-01-11 14:50:35 +0530289 sst_set_stream_status(stream, SST_PLATFORM_INIT);
Vinod Kould927fda2011-01-04 20:16:32 +0530290 stream->stream_info.period_elapsed = sst_period_elapsed;
Vinod Koul9daa5bd2014-06-13 18:03:52 +0530291 stream->stream_info.arg = substream;
Vinod Kould927fda2011-01-04 20:16:32 +0530292 stream->stream_info.buffer_ptr = 0;
293 stream->stream_info.sfreq = substream->runtime->rate;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530294 ret_val = stream->ops->stream_init(sst->dev, &stream->stream_info);
Vinod Kould927fda2011-01-04 20:16:32 +0530295 if (ret_val)
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530296 dev_err(rtd->dev, "control_set ret error %d\n", ret_val);
Vinod Kould927fda2011-01-04 20:16:32 +0530297 return ret_val;
298
299}
Vinod Kould927fda2011-01-04 20:16:32 +0530300
Vinod Koul01213272014-09-19 16:46:03 +0530301static int power_up_sst(struct sst_runtime_stream *stream)
302{
303 return stream->ops->power(sst->dev, true);
304}
305
306static void power_down_sst(struct sst_runtime_stream *stream)
307{
308 stream->ops->power(sst->dev, false);
309}
310
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530311static int sst_media_open(struct snd_pcm_substream *substream,
312 struct snd_soc_dai *dai)
Vinod Kould927fda2011-01-04 20:16:32 +0530313{
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530314 int ret_val = 0;
Lu Guanqun22be5042011-09-06 15:21:38 +0800315 struct snd_pcm_runtime *runtime = substream->runtime;
Vinod Kould927fda2011-01-04 20:16:32 +0530316 struct sst_runtime_stream *stream;
Lu Guanqun22be5042011-09-06 15:21:38 +0800317
Vinod Kould927fda2011-01-04 20:16:32 +0530318 stream = kzalloc(sizeof(*stream), GFP_KERNEL);
319 if (!stream)
320 return -ENOMEM;
Vinod Kould927fda2011-01-04 20:16:32 +0530321 spin_lock_init(&stream->status_lock);
Vinod Koul03c33042011-12-05 19:13:41 +0530322
323 /* get the sst ops */
324 mutex_lock(&sst_lock);
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530325 if (!sst ||
326 !try_module_get(sst->dev->driver->owner)) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530327 dev_err(dai->dev, "no device available to run\n");
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530328 ret_val = -ENODEV;
329 goto out_ops;
Vinod Koul03c33042011-12-05 19:13:41 +0530330 }
331 stream->ops = sst->ops;
332 mutex_unlock(&sst_lock);
333
Vinod Kould927fda2011-01-04 20:16:32 +0530334 stream->stream_info.str_id = 0;
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530335
Vinod Koul9daa5bd2014-06-13 18:03:52 +0530336 stream->stream_info.arg = substream;
Vinod Kould927fda2011-01-04 20:16:32 +0530337 /* allocate memory for SST API set */
Vinod Kould927fda2011-01-04 20:16:32 +0530338 runtime->private_data = stream;
Lu Guanqun283e42e2011-09-06 15:21:43 +0800339
Vinod Koul01213272014-09-19 16:46:03 +0530340 ret_val = power_up_sst(stream);
341 if (ret_val < 0)
342 return ret_val;
343
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530344 /* 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);
350out_ops:
351 kfree(stream);
352 mutex_unlock(&sst_lock);
353 return ret_val;
Vinod Kould927fda2011-01-04 20:16:32 +0530354}
355
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530356static void sst_media_close(struct snd_pcm_substream *substream,
357 struct snd_soc_dai *dai)
Vinod Kould927fda2011-01-04 20:16:32 +0530358{
359 struct sst_runtime_stream *stream;
360 int ret_val = 0, str_id;
361
Vinod Kould927fda2011-01-04 20:16:32 +0530362 stream = substream->runtime->private_data;
Vinod Koul01213272014-09-19 16:46:03 +0530363 power_down_sst(stream);
364
Vinod Kould927fda2011-01-04 20:16:32 +0530365 str_id = stream->stream_info.str_id;
Vinod Kould927fda2011-01-04 20:16:32 +0530366 if (str_id)
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530367 ret_val = stream->ops->close(sst->dev, str_id);
Vinod Koul03c33042011-12-05 19:13:41 +0530368 module_put(sst->dev->driver->owner);
Vinod Kould927fda2011-01-04 20:16:32 +0530369 kfree(stream);
Vinod Koul61b165c2014-06-13 18:03:56 +0530370}
371
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530372static inline unsigned int get_current_pipe_id(struct snd_soc_dai *dai,
Vinod Koul61b165c2014-06-13 18:03:56 +0530373 struct snd_pcm_substream *substream)
374{
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530375 struct sst_data *sst = snd_soc_dai_get_drvdata(dai);
Vinod Koul61b165c2014-06-13 18:03:56 +0530376 struct sst_dev_stream_map *map = sst->pdata->pdev_strm_map;
377 struct sst_runtime_stream *stream =
378 substream->runtime->private_data;
379 u32 str_id = stream->stream_info.str_id;
380 unsigned int pipe_id;
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530381
Vinod Koul61b165c2014-06-13 18:03:56 +0530382 pipe_id = map[str_id].device_id;
383
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530384 dev_dbg(dai->dev, "got pipe_id = %#x for str_id = %d\n",
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530385 pipe_id, str_id);
Vinod Koul61b165c2014-06-13 18:03:56 +0530386 return pipe_id;
Vinod Kould927fda2011-01-04 20:16:32 +0530387}
388
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530389static int sst_media_prepare(struct snd_pcm_substream *substream,
390 struct snd_soc_dai *dai)
Vinod Kould927fda2011-01-04 20:16:32 +0530391{
392 struct sst_runtime_stream *stream;
393 int ret_val = 0, str_id;
394
Vinod Kould927fda2011-01-04 20:16:32 +0530395 stream = substream->runtime->private_data;
396 str_id = stream->stream_info.str_id;
397 if (stream->stream_info.str_id) {
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530398 ret_val = stream->ops->stream_drop(sst->dev, str_id);
Vinod Kould927fda2011-01-04 20:16:32 +0530399 return ret_val;
400 }
401
Subhransu S. Prusty6df5d762014-09-09 15:11:32 +0530402 ret_val = sst_platform_alloc_stream(substream, dai);
Vinod Koula870cdc2014-06-13 18:03:55 +0530403 if (ret_val <= 0)
Vinod Kould927fda2011-01-04 20:16:32 +0530404 return ret_val;
405 snprintf(substream->pcm->id, sizeof(substream->pcm->id),
406 "%d", stream->stream_info.str_id);
407
408 ret_val = sst_platform_init_stream(substream);
409 if (ret_val)
410 return ret_val;
411 substream->runtime->hw.info = SNDRV_PCM_INFO_BLOCK_TRANSFER;
412 return ret_val;
413}
414
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530415static int sst_media_hw_params(struct snd_pcm_substream *substream,
416 struct snd_pcm_hw_params *params,
417 struct snd_soc_dai *dai)
418{
419 snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
420 memset(substream->runtime->dma_area, 0, params_buffer_bytes(params));
421 return 0;
422}
423
424static int sst_media_hw_free(struct snd_pcm_substream *substream,
425 struct snd_soc_dai *dai)
426{
427 return snd_pcm_lib_free_pages(substream);
428}
429
Vinod Koulc82351d2014-10-15 20:12:59 +0530430static int sst_enable_ssp(struct snd_pcm_substream *substream,
431 struct snd_soc_dai *dai)
432{
433 int ret = 0;
434
435 if (!dai->active) {
436 ret = sst_handle_vb_timer(dai, true);
Vinod Koul711bc942015-05-06 22:06:42 +0530437 sst_fill_ssp_defaults(dai);
Vinod Koulc82351d2014-10-15 20:12:59 +0530438 }
439 return ret;
440}
441
Vinod Koul711bc942015-05-06 22:06:42 +0530442static int sst_be_hw_params(struct snd_pcm_substream *substream,
443 struct snd_pcm_hw_params *params,
444 struct snd_soc_dai *dai)
445{
446 int ret = 0;
447
448 if (dai->active == 1)
449 ret = send_ssp_cmd(dai, dai->name, 1);
450 return ret;
451}
452
Vinod Koul0b44e342015-05-06 22:06:43 +0530453static int sst_set_format(struct snd_soc_dai *dai, unsigned int fmt)
454{
455 int ret = 0;
456
457 if (!dai->active)
458 return 0;
459
460 ret = sst_fill_ssp_config(dai, fmt);
461 if (ret < 0)
462 dev_err(dai->dev, "sst_set_format failed..\n");
463
464 return ret;
465}
466
Vinod Koul83f125e2015-05-06 22:06:44 +0530467static int sst_platform_set_ssp_slot(struct snd_soc_dai *dai,
468 unsigned int tx_mask, unsigned int rx_mask,
469 int slots, int slot_width) {
470 int ret = 0;
471
472 if (!dai->active)
473 return ret;
474
475 ret = sst_fill_ssp_slot(dai, tx_mask, rx_mask, slots, slot_width);
476 if (ret < 0)
477 dev_err(dai->dev, "sst_fill_ssp_slot failed..%d\n", ret);
478
479 return ret;
480}
481
Vinod Koulc82351d2014-10-15 20:12:59 +0530482static void sst_disable_ssp(struct snd_pcm_substream *substream,
483 struct snd_soc_dai *dai)
484{
485 if (!dai->active) {
486 send_ssp_cmd(dai, dai->name, 0);
487 sst_handle_vb_timer(dai, false);
488 }
489}
490
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530491static struct snd_soc_dai_ops sst_media_dai_ops = {
492 .startup = sst_media_open,
493 .shutdown = sst_media_close,
494 .prepare = sst_media_prepare,
495 .hw_params = sst_media_hw_params,
496 .hw_free = sst_media_hw_free,
Vinod Koulc82351d2014-10-15 20:12:59 +0530497 .mute_stream = sst_media_digital_mute,
498};
499
500static struct snd_soc_dai_ops sst_compr_dai_ops = {
501 .mute_stream = sst_media_digital_mute,
502};
503
504static struct snd_soc_dai_ops sst_be_dai_ops = {
505 .startup = sst_enable_ssp,
Vinod Koul711bc942015-05-06 22:06:42 +0530506 .hw_params = sst_be_hw_params,
Vinod Koul0b44e342015-05-06 22:06:43 +0530507 .set_fmt = sst_set_format,
Vinod Koul83f125e2015-05-06 22:06:44 +0530508 .set_tdm_slot = sst_platform_set_ssp_slot,
Vinod Koulc82351d2014-10-15 20:12:59 +0530509 .shutdown = sst_disable_ssp,
510};
511
512static struct snd_soc_dai_driver sst_platform_dai[] = {
513{
514 .name = "media-cpu-dai",
515 .ops = &sst_media_dai_ops,
516 .playback = {
517 .stream_name = "Headset Playback",
518 .channels_min = SST_STEREO,
519 .channels_max = SST_STEREO,
520 .rates = SNDRV_PCM_RATE_44100|SNDRV_PCM_RATE_48000,
521 .formats = SNDRV_PCM_FMTBIT_S16_LE,
522 },
523 .capture = {
524 .stream_name = "Headset Capture",
525 .channels_min = 1,
526 .channels_max = 2,
527 .rates = SNDRV_PCM_RATE_44100|SNDRV_PCM_RATE_48000,
528 .formats = SNDRV_PCM_FMTBIT_S16_LE,
529 },
530},
531{
532 .name = "compress-cpu-dai",
533 .compress_dai = 1,
534 .ops = &sst_compr_dai_ops,
535 .playback = {
536 .stream_name = "Compress Playback",
537 .channels_min = SST_STEREO,
538 .channels_max = SST_STEREO,
539 .rates = SNDRV_PCM_RATE_48000,
540 .formats = SNDRV_PCM_FMTBIT_S16_LE,
541 },
542},
543/* BE CPU Dais */
544{
545 .name = "ssp0-port",
546 .ops = &sst_be_dai_ops,
547 .playback = {
548 .stream_name = "ssp0 Tx",
549 .channels_min = SST_STEREO,
550 .channels_max = SST_STEREO,
551 .rates = SNDRV_PCM_RATE_48000,
552 .formats = SNDRV_PCM_FMTBIT_S16_LE,
553 },
554 .capture = {
555 .stream_name = "ssp0 Rx",
556 .channels_min = SST_STEREO,
557 .channels_max = SST_STEREO,
558 .rates = SNDRV_PCM_RATE_48000,
559 .formats = SNDRV_PCM_FMTBIT_S16_LE,
560 },
561},
562{
563 .name = "ssp1-port",
564 .ops = &sst_be_dai_ops,
565 .playback = {
566 .stream_name = "ssp1 Tx",
567 .channels_min = SST_STEREO,
568 .channels_max = SST_STEREO,
569 .rates = SNDRV_PCM_RATE_8000|SNDRV_PCM_RATE_16000|SNDRV_PCM_RATE_48000,
570 .formats = SNDRV_PCM_FMTBIT_S16_LE,
571 },
572 .capture = {
573 .stream_name = "ssp1 Rx",
574 .channels_min = SST_STEREO,
575 .channels_max = SST_STEREO,
576 .rates = SNDRV_PCM_RATE_8000|SNDRV_PCM_RATE_16000|SNDRV_PCM_RATE_48000,
577 .formats = SNDRV_PCM_FMTBIT_S16_LE,
578 },
579},
580{
581 .name = "ssp2-port",
582 .ops = &sst_be_dai_ops,
583 .playback = {
584 .stream_name = "ssp2 Tx",
585 .channels_min = SST_STEREO,
586 .channels_max = SST_STEREO,
587 .rates = SNDRV_PCM_RATE_48000,
588 .formats = SNDRV_PCM_FMTBIT_S16_LE,
589 },
590 .capture = {
591 .stream_name = "ssp2 Rx",
592 .channels_min = SST_STEREO,
593 .channels_max = SST_STEREO,
594 .rates = SNDRV_PCM_RATE_48000,
595 .formats = SNDRV_PCM_FMTBIT_S16_LE,
596 },
597},
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530598};
599
600static int sst_platform_open(struct snd_pcm_substream *substream)
601{
602 struct snd_pcm_runtime *runtime;
603
604 if (substream->pcm->internal)
605 return 0;
606
607 runtime = substream->runtime;
608 runtime->hw = sst_platform_pcm_hw;
609 return 0;
610}
611
Vinod Koul5106f5a2014-05-15 21:38:15 +0530612static int sst_platform_pcm_trigger(struct snd_pcm_substream *substream,
Vinod Kould927fda2011-01-04 20:16:32 +0530613 int cmd)
614{
615 int ret_val = 0, str_id;
616 struct sst_runtime_stream *stream;
Subhransu S. Prusty5981c2d2014-08-04 15:04:20 +0530617 int status;
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530618 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Vinod Kould927fda2011-01-04 20:16:32 +0530619
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530620 dev_dbg(rtd->dev, "sst_platform_pcm_trigger called\n");
Vinod Kould2b16b82014-09-09 15:11:24 +0530621 if (substream->pcm->internal)
622 return 0;
Vinod Kould927fda2011-01-04 20:16:32 +0530623 stream = substream->runtime->private_data;
Vinod Kould927fda2011-01-04 20:16:32 +0530624 str_id = stream->stream_info.str_id;
Vinod Kould927fda2011-01-04 20:16:32 +0530625 switch (cmd) {
626 case SNDRV_PCM_TRIGGER_START:
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530627 dev_dbg(rtd->dev, "sst: Trigger Start\n");
Harsha Priyaa2117012011-01-11 14:50:59 +0530628 status = SST_PLATFORM_RUNNING;
Vinod Koul9daa5bd2014-06-13 18:03:52 +0530629 stream->stream_info.arg = substream;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530630 ret_val = stream->ops->stream_start(sst->dev, str_id);
Vinod Kould927fda2011-01-04 20:16:32 +0530631 break;
632 case SNDRV_PCM_TRIGGER_STOP:
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530633 dev_dbg(rtd->dev, "sst: in stop\n");
Harsha Priyaa2117012011-01-11 14:50:59 +0530634 status = SST_PLATFORM_DROPPED;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530635 ret_val = stream->ops->stream_drop(sst->dev, str_id);
Vinod Kould927fda2011-01-04 20:16:32 +0530636 break;
637 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
Vinod Koulfc9406a2015-02-12 09:59:57 +0530638 case SNDRV_PCM_TRIGGER_SUSPEND:
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530639 dev_dbg(rtd->dev, "sst: in pause\n");
Harsha Priyaa2117012011-01-11 14:50:59 +0530640 status = SST_PLATFORM_PAUSED;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530641 ret_val = stream->ops->stream_pause(sst->dev, str_id);
Vinod Kould927fda2011-01-04 20:16:32 +0530642 break;
643 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
Vinod Koulfc9406a2015-02-12 09:59:57 +0530644 case SNDRV_PCM_TRIGGER_RESUME:
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530645 dev_dbg(rtd->dev, "sst: in pause release\n");
Harsha Priyaa2117012011-01-11 14:50:59 +0530646 status = SST_PLATFORM_RUNNING;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530647 ret_val = stream->ops->stream_pause_release(sst->dev, str_id);
Vinod Kould927fda2011-01-04 20:16:32 +0530648 break;
649 default:
Harsha Priyaa2117012011-01-11 14:50:59 +0530650 return -EINVAL;
Vinod Kould927fda2011-01-04 20:16:32 +0530651 }
Subhransu S. Prusty5981c2d2014-08-04 15:04:20 +0530652
Harsha Priyaa2117012011-01-11 14:50:59 +0530653 if (!ret_val)
654 sst_set_stream_status(stream, status);
655
Vinod Kould927fda2011-01-04 20:16:32 +0530656 return ret_val;
657}
658
659
Vinod Koul5106f5a2014-05-15 21:38:15 +0530660static snd_pcm_uframes_t sst_platform_pcm_pointer
Vinod Kould927fda2011-01-04 20:16:32 +0530661 (struct snd_pcm_substream *substream)
662{
663 struct sst_runtime_stream *stream;
Harsha Priya5c685362011-01-11 14:50:35 +0530664 int ret_val, status;
Vinod Kould927fda2011-01-04 20:16:32 +0530665 struct pcm_stream_info *str_info;
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530666 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Vinod Kould927fda2011-01-04 20:16:32 +0530667
Vinod Kould927fda2011-01-04 20:16:32 +0530668 stream = substream->runtime->private_data;
Harsha Priya5c685362011-01-11 14:50:35 +0530669 status = sst_get_stream_status(stream);
670 if (status == SST_PLATFORM_INIT)
Vinod Kould927fda2011-01-04 20:16:32 +0530671 return 0;
Vinod Kould927fda2011-01-04 20:16:32 +0530672 str_info = &stream->stream_info;
Subhransu S. Prustyb12b087c2014-08-04 15:04:21 +0530673 ret_val = stream->ops->stream_read_tstamp(sst->dev, str_info);
Vinod Kould927fda2011-01-04 20:16:32 +0530674 if (ret_val) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530675 dev_err(rtd->dev, "sst: error code = %d\n", ret_val);
Vinod Kould927fda2011-01-04 20:16:32 +0530676 return ret_val;
677 }
Vinod Koul2a635822014-06-13 18:03:53 +0530678 substream->runtime->delay = str_info->pcm_delay;
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530679 return str_info->buffer_ptr;
xingchao9ab88432011-04-27 16:58:54 -0400680}
681
Vinod Kould927fda2011-01-04 20:16:32 +0530682static struct snd_pcm_ops sst_platform_ops = {
Vinod Koul5106f5a2014-05-15 21:38:15 +0530683 .open = sst_platform_open,
Vinod Kould927fda2011-01-04 20:16:32 +0530684 .ioctl = snd_pcm_lib_ioctl,
Vinod Koul5106f5a2014-05-15 21:38:15 +0530685 .trigger = sst_platform_pcm_trigger,
686 .pointer = sst_platform_pcm_pointer,
Vinod Kould927fda2011-01-04 20:16:32 +0530687};
688
Axel Lin8faa8c12011-12-13 17:13:45 +0800689static int sst_pcm_new(struct snd_soc_pcm_runtime *rtd)
Vinod Kould927fda2011-01-04 20:16:32 +0530690{
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530691 struct snd_soc_dai *dai = rtd->cpu_dai;
Liam Girdwood552d1ef2011-06-07 16:08:33 +0100692 struct snd_pcm *pcm = rtd->pcm;
Vinod Kould927fda2011-01-04 20:16:32 +0530693 int retval = 0;
694
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530695 if (dai->driver->playback.channels_min ||
696 dai->driver->capture.channels_min) {
Vinod Kould927fda2011-01-04 20:16:32 +0530697 retval = snd_pcm_lib_preallocate_pages_for_all(pcm,
698 SNDRV_DMA_TYPE_CONTINUOUS,
Vinod Koul6cc0f4e2014-06-13 18:03:51 +0530699 snd_dma_continuous_data(GFP_DMA),
Vinod Kould927fda2011-01-04 20:16:32 +0530700 SST_MIN_BUFFER, SST_MAX_BUFFER);
701 if (retval) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530702 dev_err(rtd->dev, "dma buffer allocationf fail\n");
Vinod Kould927fda2011-01-04 20:16:32 +0530703 return retval;
704 }
705 }
Vinod Kould927fda2011-01-04 20:16:32 +0530706 return retval;
707}
Vinod Koulc514a912012-08-16 17:10:42 +0530708
Vinod Kould8499c92014-08-04 15:15:55 +0530709static int sst_soc_probe(struct snd_soc_platform *platform)
710{
Vinod Koul54e6bec2015-02-12 09:59:58 +0530711 struct sst_data *drv = dev_get_drvdata(platform->dev);
712
713 drv->soc_card = platform->component.card;
Vinod Kould8499c92014-08-04 15:15:55 +0530714 return sst_dsp_init_v2_dpcm(platform);
715}
716
717static struct snd_soc_platform_driver sst_soc_platform_drv = {
718 .probe = sst_soc_probe,
Vinod Kould927fda2011-01-04 20:16:32 +0530719 .ops = &sst_platform_ops,
Vinod Koulc514a912012-08-16 17:10:42 +0530720 .compr_ops = &sst_platform_compr_ops,
Vinod Kould927fda2011-01-04 20:16:32 +0530721 .pcm_new = sst_pcm_new,
Vinod Kould927fda2011-01-04 20:16:32 +0530722};
723
Vinod Koul2b4c78d2014-05-05 22:19:25 +0530724static const struct snd_soc_component_driver sst_component = {
725 .name = "sst",
726};
727
728
Vinod Kould927fda2011-01-04 20:16:32 +0530729static int sst_platform_probe(struct platform_device *pdev)
730{
Vinod Koul61b165c2014-06-13 18:03:56 +0530731 struct sst_data *drv;
Vinod Kould927fda2011-01-04 20:16:32 +0530732 int ret;
Subhransu S. Prusty2741d432014-07-30 18:39:05 +0530733 struct sst_platform_data *pdata;
Vinod Kould927fda2011-01-04 20:16:32 +0530734
Vinod Koul61b165c2014-06-13 18:03:56 +0530735 drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL);
Subhransu S. Prusty19a23a52014-07-30 18:36:00 +0530736 if (drv == NULL) {
Vinod Koul61b165c2014-06-13 18:03:56 +0530737 return -ENOMEM;
738 }
739
Subhransu S. Prusty2741d432014-07-30 18:39:05 +0530740 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
741 if (pdata == NULL) {
Subhransu S. Prusty2741d432014-07-30 18:39:05 +0530742 return -ENOMEM;
743 }
744
Vinod Koul61b165c2014-06-13 18:03:56 +0530745 pdata->pdev_strm_map = dpcm_strm_map;
746 pdata->strm_map_size = ARRAY_SIZE(dpcm_strm_map);
747 drv->pdata = pdata;
Subhransu S. Prusty3172fcd2014-10-30 16:21:44 +0530748 drv->pdev = pdev;
Vinod Koul61b165c2014-06-13 18:03:56 +0530749 mutex_init(&drv->lock);
750 dev_set_drvdata(&pdev->dev, drv);
751
Vinod Kould927fda2011-01-04 20:16:32 +0530752 ret = snd_soc_register_platform(&pdev->dev, &sst_soc_platform_drv);
753 if (ret) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530754 dev_err(&pdev->dev, "registering soc platform failed\n");
Vinod Kould927fda2011-01-04 20:16:32 +0530755 return ret;
756 }
Harsha Priya5c685362011-01-11 14:50:35 +0530757
Kuninori Morimotob1c36862013-03-21 03:32:50 -0700758 ret = snd_soc_register_component(&pdev->dev, &sst_component,
Vinod Kould927fda2011-01-04 20:16:32 +0530759 sst_platform_dai, ARRAY_SIZE(sst_platform_dai));
760 if (ret) {
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530761 dev_err(&pdev->dev, "registering cpu dais failed\n");
Vinod Kould927fda2011-01-04 20:16:32 +0530762 snd_soc_unregister_platform(&pdev->dev);
763 }
764 return ret;
765}
766
767static int sst_platform_remove(struct platform_device *pdev)
768{
769
Kuninori Morimotob1c36862013-03-21 03:32:50 -0700770 snd_soc_unregister_component(&pdev->dev);
Vinod Kould927fda2011-01-04 20:16:32 +0530771 snd_soc_unregister_platform(&pdev->dev);
Subhransu S. Prusty02024752014-09-02 18:05:56 +0530772 dev_dbg(&pdev->dev, "sst_platform_remove success\n");
Vinod Kould927fda2011-01-04 20:16:32 +0530773 return 0;
774}
775
Vinod Koul54e6bec2015-02-12 09:59:58 +0530776#ifdef CONFIG_PM_SLEEP
777
778static int sst_soc_prepare(struct device *dev)
779{
780 struct sst_data *drv = dev_get_drvdata(dev);
781 int i;
782
783 /* suspend all pcms first */
784 snd_soc_suspend(drv->soc_card->dev);
785 snd_soc_poweroff(drv->soc_card->dev);
786
787 /* set the SSPs to idle */
788 for (i = 0; i < drv->soc_card->num_rtd; i++) {
789 struct snd_soc_dai *dai = drv->soc_card->rtd[i].cpu_dai;
790
791 if (dai->active) {
792 send_ssp_cmd(dai, dai->name, 0);
793 sst_handle_vb_timer(dai, false);
794 }
795 }
796
797 return 0;
798}
799
800static void sst_soc_complete(struct device *dev)
801{
802 struct sst_data *drv = dev_get_drvdata(dev);
803 int i;
804
805 /* restart SSPs */
806 for (i = 0; i < drv->soc_card->num_rtd; i++) {
807 struct snd_soc_dai *dai = drv->soc_card->rtd[i].cpu_dai;
808
809 if (dai->active) {
810 sst_handle_vb_timer(dai, true);
811 send_ssp_cmd(dai, dai->name, 1);
812 }
813 }
814 snd_soc_resume(drv->soc_card->dev);
815}
816
817#else
818
819#define sst_soc_prepare NULL
820#define sst_soc_complete NULL
821
822#endif
823
824
825static const struct dev_pm_ops sst_platform_pm = {
826 .prepare = sst_soc_prepare,
827 .complete = sst_soc_complete,
828};
829
Vinod Kould927fda2011-01-04 20:16:32 +0530830static struct platform_driver sst_platform_driver = {
831 .driver = {
Mark Browna4b12992014-03-12 23:04:35 +0000832 .name = "sst-mfld-platform",
Vinod Koul54e6bec2015-02-12 09:59:58 +0530833 .pm = &sst_platform_pm,
Vinod Kould927fda2011-01-04 20:16:32 +0530834 },
835 .probe = sst_platform_probe,
836 .remove = sst_platform_remove,
837};
838
Axel Lin29515d62011-11-24 11:51:56 +0800839module_platform_driver(sst_platform_driver);
Vinod Kould927fda2011-01-04 20:16:32 +0530840
841MODULE_DESCRIPTION("ASoC Intel(R) MID Platform driver");
842MODULE_AUTHOR("Vinod Koul <vinod.koul@intel.com>");
843MODULE_AUTHOR("Harsha Priya <priya.harsha@intel.com>");
844MODULE_LICENSE("GPL v2");
Mark Browna4b12992014-03-12 23:04:35 +0000845MODULE_ALIAS("platform:sst-mfld-platform");