Vinod Koul | 4b68b4e | 2014-05-05 14:27:50 +0530 | [diff] [blame] | 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 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or modify |
| 9 | * it under the terms of the GNU General Public License as published by |
| 10 | * the Free Software Foundation; version 2 of the License. |
| 11 | * |
| 12 | * This program is distributed in the hope that it will be useful, but |
| 13 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 15 | * General Public License for more details. |
| 16 | * |
| 17 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| 18 | */ |
| 19 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| 20 | |
| 21 | #include <linux/slab.h> |
| 22 | #include <linux/io.h> |
| 23 | #include <linux/module.h> |
| 24 | #include <sound/core.h> |
| 25 | #include <sound/pcm.h> |
| 26 | #include <sound/pcm_params.h> |
| 27 | #include <sound/soc.h> |
| 28 | #include <sound/compress_driver.h> |
| 29 | #include "sst-mfld-platform.h" |
| 30 | |
| 31 | /* compress stream operations */ |
| 32 | static void sst_compr_fragment_elapsed(void *arg) |
| 33 | { |
| 34 | struct snd_compr_stream *cstream = (struct snd_compr_stream *)arg; |
| 35 | |
| 36 | pr_debug("fragment elapsed by driver\n"); |
| 37 | if (cstream) |
| 38 | snd_compr_fragment_elapsed(cstream); |
| 39 | } |
| 40 | |
Vinod Koul | bd17aa4 | 2014-05-15 21:38:16 +0530 | [diff] [blame] | 41 | static void sst_drain_notify(void *arg) |
| 42 | { |
| 43 | struct snd_compr_stream *cstream = (struct snd_compr_stream *)arg; |
| 44 | |
| 45 | pr_debug("drain notify by driver\n"); |
| 46 | if (cstream) |
| 47 | snd_compr_drain_notify(cstream); |
| 48 | } |
| 49 | |
Vinod Koul | 4b68b4e | 2014-05-05 14:27:50 +0530 | [diff] [blame] | 50 | static int sst_platform_compr_open(struct snd_compr_stream *cstream) |
| 51 | { |
| 52 | |
| 53 | int ret_val = 0; |
| 54 | struct snd_compr_runtime *runtime = cstream->runtime; |
| 55 | struct sst_runtime_stream *stream; |
| 56 | |
| 57 | stream = kzalloc(sizeof(*stream), GFP_KERNEL); |
| 58 | if (!stream) |
| 59 | return -ENOMEM; |
| 60 | |
| 61 | spin_lock_init(&stream->status_lock); |
| 62 | |
| 63 | /* get the sst ops */ |
| 64 | if (!sst || !try_module_get(sst->dev->driver->owner)) { |
| 65 | pr_err("no device available to run\n"); |
| 66 | ret_val = -ENODEV; |
| 67 | goto out_ops; |
| 68 | } |
| 69 | stream->compr_ops = sst->compr_ops; |
| 70 | |
| 71 | stream->id = 0; |
| 72 | sst_set_stream_status(stream, SST_PLATFORM_INIT); |
| 73 | runtime->private_data = stream; |
| 74 | return 0; |
| 75 | out_ops: |
| 76 | kfree(stream); |
| 77 | return ret_val; |
| 78 | } |
| 79 | |
| 80 | static int sst_platform_compr_free(struct snd_compr_stream *cstream) |
| 81 | { |
| 82 | struct sst_runtime_stream *stream; |
| 83 | int ret_val = 0, str_id; |
| 84 | |
| 85 | stream = cstream->runtime->private_data; |
| 86 | /*need to check*/ |
| 87 | str_id = stream->id; |
| 88 | if (str_id) |
| 89 | ret_val = stream->compr_ops->close(str_id); |
| 90 | module_put(sst->dev->driver->owner); |
| 91 | kfree(stream); |
| 92 | pr_debug("%s: %d\n", __func__, ret_val); |
| 93 | return 0; |
| 94 | } |
| 95 | |
| 96 | static int sst_platform_compr_set_params(struct snd_compr_stream *cstream, |
| 97 | struct snd_compr_params *params) |
| 98 | { |
| 99 | struct sst_runtime_stream *stream; |
| 100 | int retval; |
| 101 | struct snd_sst_params str_params; |
| 102 | struct sst_compress_cb cb; |
| 103 | |
| 104 | stream = cstream->runtime->private_data; |
| 105 | /* construct fw structure for this*/ |
| 106 | memset(&str_params, 0, sizeof(str_params)); |
| 107 | |
| 108 | str_params.ops = STREAM_OPS_PLAYBACK; |
| 109 | str_params.stream_type = SST_STREAM_TYPE_MUSIC; |
| 110 | str_params.device_type = SND_SST_DEVICE_COMPRESS; |
| 111 | |
| 112 | switch (params->codec.id) { |
| 113 | case SND_AUDIOCODEC_MP3: { |
| 114 | str_params.codec = SST_CODEC_TYPE_MP3; |
Vinod Koul | 4b68b4e | 2014-05-05 14:27:50 +0530 | [diff] [blame] | 115 | str_params.sparams.uc.mp3_params.num_chan = params->codec.ch_in; |
| 116 | str_params.sparams.uc.mp3_params.pcm_wd_sz = 16; |
| 117 | break; |
| 118 | } |
| 119 | |
| 120 | case SND_AUDIOCODEC_AAC: { |
| 121 | str_params.codec = SST_CODEC_TYPE_AAC; |
Vinod Koul | 4b68b4e | 2014-05-05 14:27:50 +0530 | [diff] [blame] | 122 | str_params.sparams.uc.aac_params.num_chan = params->codec.ch_in; |
| 123 | str_params.sparams.uc.aac_params.pcm_wd_sz = 16; |
| 124 | if (params->codec.format == SND_AUDIOSTREAMFORMAT_MP4ADTS) |
| 125 | str_params.sparams.uc.aac_params.bs_format = |
| 126 | AAC_BIT_STREAM_ADTS; |
| 127 | else if (params->codec.format == SND_AUDIOSTREAMFORMAT_RAW) |
| 128 | str_params.sparams.uc.aac_params.bs_format = |
| 129 | AAC_BIT_STREAM_RAW; |
| 130 | else { |
| 131 | pr_err("Undefined format%d\n", params->codec.format); |
| 132 | return -EINVAL; |
| 133 | } |
| 134 | str_params.sparams.uc.aac_params.externalsr = |
| 135 | params->codec.sample_rate; |
| 136 | break; |
| 137 | } |
| 138 | |
| 139 | default: |
| 140 | pr_err("codec not supported, id =%d\n", params->codec.id); |
| 141 | return -EINVAL; |
| 142 | } |
| 143 | |
| 144 | str_params.aparams.ring_buf_info[0].addr = |
| 145 | virt_to_phys(cstream->runtime->buffer); |
| 146 | str_params.aparams.ring_buf_info[0].size = |
| 147 | cstream->runtime->buffer_size; |
| 148 | str_params.aparams.sg_count = 1; |
| 149 | str_params.aparams.frag_size = cstream->runtime->fragment_size; |
| 150 | |
| 151 | cb.param = cstream; |
| 152 | cb.compr_cb = sst_compr_fragment_elapsed; |
Vinod Koul | bd17aa4 | 2014-05-15 21:38:16 +0530 | [diff] [blame] | 153 | cb.drain_cb_param = cstream; |
| 154 | cb.drain_notify = sst_drain_notify; |
Vinod Koul | 4b68b4e | 2014-05-05 14:27:50 +0530 | [diff] [blame] | 155 | |
| 156 | retval = stream->compr_ops->open(&str_params, &cb); |
| 157 | if (retval < 0) { |
| 158 | pr_err("stream allocation failed %d\n", retval); |
| 159 | return retval; |
| 160 | } |
| 161 | |
| 162 | stream->id = retval; |
| 163 | return 0; |
| 164 | } |
| 165 | |
| 166 | static int sst_platform_compr_trigger(struct snd_compr_stream *cstream, int cmd) |
| 167 | { |
| 168 | struct sst_runtime_stream *stream = |
| 169 | cstream->runtime->private_data; |
| 170 | |
| 171 | return stream->compr_ops->control(cmd, stream->id); |
| 172 | } |
| 173 | |
| 174 | static int sst_platform_compr_pointer(struct snd_compr_stream *cstream, |
| 175 | struct snd_compr_tstamp *tstamp) |
| 176 | { |
| 177 | struct sst_runtime_stream *stream; |
| 178 | |
| 179 | stream = cstream->runtime->private_data; |
| 180 | stream->compr_ops->tstamp(stream->id, tstamp); |
| 181 | tstamp->byte_offset = tstamp->copied_total % |
| 182 | (u32)cstream->runtime->buffer_size; |
| 183 | pr_debug("calc bytes offset/copied bytes as %d\n", tstamp->byte_offset); |
| 184 | return 0; |
| 185 | } |
| 186 | |
| 187 | static int sst_platform_compr_ack(struct snd_compr_stream *cstream, |
| 188 | size_t bytes) |
| 189 | { |
| 190 | struct sst_runtime_stream *stream; |
| 191 | |
| 192 | stream = cstream->runtime->private_data; |
| 193 | stream->compr_ops->ack(stream->id, (unsigned long)bytes); |
| 194 | stream->bytes_written += bytes; |
| 195 | |
| 196 | return 0; |
| 197 | } |
| 198 | |
| 199 | static int sst_platform_compr_get_caps(struct snd_compr_stream *cstream, |
| 200 | struct snd_compr_caps *caps) |
| 201 | { |
| 202 | struct sst_runtime_stream *stream = |
| 203 | cstream->runtime->private_data; |
| 204 | |
| 205 | return stream->compr_ops->get_caps(caps); |
| 206 | } |
| 207 | |
| 208 | static int sst_platform_compr_get_codec_caps(struct snd_compr_stream *cstream, |
| 209 | struct snd_compr_codec_caps *codec) |
| 210 | { |
| 211 | struct sst_runtime_stream *stream = |
| 212 | cstream->runtime->private_data; |
| 213 | |
| 214 | return stream->compr_ops->get_codec_caps(codec); |
| 215 | } |
| 216 | |
| 217 | static int sst_platform_compr_set_metadata(struct snd_compr_stream *cstream, |
| 218 | struct snd_compr_metadata *metadata) |
| 219 | { |
| 220 | struct sst_runtime_stream *stream = |
| 221 | cstream->runtime->private_data; |
| 222 | |
| 223 | return stream->compr_ops->set_metadata(stream->id, metadata); |
| 224 | } |
| 225 | |
| 226 | struct snd_compr_ops sst_platform_compr_ops = { |
| 227 | |
| 228 | .open = sst_platform_compr_open, |
| 229 | .free = sst_platform_compr_free, |
| 230 | .set_params = sst_platform_compr_set_params, |
| 231 | .set_metadata = sst_platform_compr_set_metadata, |
| 232 | .trigger = sst_platform_compr_trigger, |
| 233 | .pointer = sst_platform_compr_pointer, |
| 234 | .ack = sst_platform_compr_ack, |
| 235 | .get_caps = sst_platform_compr_get_caps, |
| 236 | .get_codec_caps = sst_platform_compr_get_codec_caps, |
| 237 | }; |