Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 1 | /* |
| 2 | * bebob_pcm.c - a part of driver for BeBoB based devices |
| 3 | * |
| 4 | * Copyright (c) 2013-2014 Takashi Sakamoto |
| 5 | * |
| 6 | * Licensed under the terms of the GNU General Public License, version 2. |
| 7 | */ |
| 8 | |
| 9 | #include "./bebob.h" |
| 10 | |
| 11 | static int |
| 12 | hw_rule_rate(struct snd_pcm_hw_params *params, struct snd_pcm_hw_rule *rule) |
| 13 | { |
| 14 | struct snd_bebob_stream_formation *formations = rule->private; |
| 15 | struct snd_interval *r = |
| 16 | hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); |
| 17 | const struct snd_interval *c = |
| 18 | hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_CHANNELS); |
| 19 | struct snd_interval t = { |
| 20 | .min = UINT_MAX, .max = 0, .integer = 1 |
| 21 | }; |
| 22 | unsigned int i; |
| 23 | |
| 24 | for (i = 0; i < SND_BEBOB_STRM_FMT_ENTRIES; i++) { |
| 25 | /* entry is invalid */ |
| 26 | if (formations[i].pcm == 0) |
| 27 | continue; |
| 28 | |
| 29 | if (!snd_interval_test(c, formations[i].pcm)) |
| 30 | continue; |
| 31 | |
| 32 | t.min = min(t.min, snd_bebob_rate_table[i]); |
| 33 | t.max = max(t.max, snd_bebob_rate_table[i]); |
| 34 | |
| 35 | } |
| 36 | return snd_interval_refine(r, &t); |
| 37 | } |
| 38 | |
| 39 | static int |
| 40 | hw_rule_channels(struct snd_pcm_hw_params *params, struct snd_pcm_hw_rule *rule) |
| 41 | { |
| 42 | struct snd_bebob_stream_formation *formations = rule->private; |
| 43 | struct snd_interval *c = |
| 44 | hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); |
| 45 | const struct snd_interval *r = |
| 46 | hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_RATE); |
| 47 | struct snd_interval t = { |
| 48 | .min = UINT_MAX, .max = 0, .integer = 1 |
| 49 | }; |
| 50 | |
| 51 | unsigned int i; |
| 52 | |
| 53 | for (i = 0; i < SND_BEBOB_STRM_FMT_ENTRIES; i++) { |
| 54 | /* entry is invalid */ |
| 55 | if (formations[i].pcm == 0) |
| 56 | continue; |
| 57 | |
| 58 | if (!snd_interval_test(r, snd_bebob_rate_table[i])) |
| 59 | continue; |
| 60 | |
| 61 | t.min = min(t.min, formations[i].pcm); |
| 62 | t.max = max(t.max, formations[i].pcm); |
| 63 | } |
| 64 | |
| 65 | return snd_interval_refine(c, &t); |
| 66 | } |
| 67 | |
| 68 | static void |
| 69 | limit_channels_and_rates(struct snd_pcm_hardware *hw, |
| 70 | struct snd_bebob_stream_formation *formations) |
| 71 | { |
| 72 | unsigned int i; |
| 73 | |
| 74 | hw->channels_min = UINT_MAX; |
| 75 | hw->channels_max = 0; |
| 76 | |
| 77 | hw->rate_min = UINT_MAX; |
| 78 | hw->rate_max = 0; |
| 79 | hw->rates = 0; |
| 80 | |
| 81 | for (i = 0; i < SND_BEBOB_STRM_FMT_ENTRIES; i++) { |
| 82 | /* entry has no PCM channels */ |
| 83 | if (formations[i].pcm == 0) |
| 84 | continue; |
| 85 | |
| 86 | hw->channels_min = min(hw->channels_min, formations[i].pcm); |
| 87 | hw->channels_max = max(hw->channels_max, formations[i].pcm); |
| 88 | |
| 89 | hw->rate_min = min(hw->rate_min, snd_bebob_rate_table[i]); |
| 90 | hw->rate_max = max(hw->rate_max, snd_bebob_rate_table[i]); |
| 91 | hw->rates |= snd_pcm_rate_to_rate_bit(snd_bebob_rate_table[i]); |
| 92 | } |
| 93 | } |
| 94 | |
| 95 | static void |
| 96 | limit_period_and_buffer(struct snd_pcm_hardware *hw) |
| 97 | { |
| 98 | hw->periods_min = 2; /* SNDRV_PCM_INFO_BATCH */ |
| 99 | hw->periods_max = UINT_MAX; |
| 100 | |
| 101 | hw->period_bytes_min = 4 * hw->channels_max; /* bytes for a frame */ |
| 102 | |
| 103 | /* Just to prevent from allocating much pages. */ |
| 104 | hw->period_bytes_max = hw->period_bytes_min * 2048; |
| 105 | hw->buffer_bytes_max = hw->period_bytes_max * hw->periods_min; |
| 106 | } |
| 107 | |
| 108 | static int |
| 109 | pcm_init_hw_params(struct snd_bebob *bebob, |
| 110 | struct snd_pcm_substream *substream) |
| 111 | { |
| 112 | struct snd_pcm_runtime *runtime = substream->runtime; |
| 113 | struct amdtp_stream *s; |
| 114 | struct snd_bebob_stream_formation *formations; |
| 115 | int err; |
| 116 | |
| 117 | runtime->hw.info = SNDRV_PCM_INFO_BATCH | |
| 118 | SNDRV_PCM_INFO_BLOCK_TRANSFER | |
| 119 | SNDRV_PCM_INFO_INTERLEAVED | |
| 120 | SNDRV_PCM_INFO_JOINT_DUPLEX | |
| 121 | SNDRV_PCM_INFO_MMAP | |
| 122 | SNDRV_PCM_INFO_MMAP_VALID; |
| 123 | |
| 124 | if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) { |
| 125 | runtime->hw.formats = AMDTP_IN_PCM_FORMAT_BITS; |
| 126 | s = &bebob->tx_stream; |
| 127 | formations = bebob->tx_stream_formations; |
| 128 | } else { |
| 129 | runtime->hw.formats = AMDTP_OUT_PCM_FORMAT_BITS; |
| 130 | s = &bebob->rx_stream; |
| 131 | formations = bebob->rx_stream_formations; |
| 132 | } |
| 133 | |
| 134 | limit_channels_and_rates(&runtime->hw, formations); |
| 135 | limit_period_and_buffer(&runtime->hw); |
| 136 | |
| 137 | err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS, |
| 138 | hw_rule_channels, formations, |
| 139 | SNDRV_PCM_HW_PARAM_RATE, -1); |
| 140 | if (err < 0) |
| 141 | goto end; |
| 142 | |
| 143 | err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, |
| 144 | hw_rule_rate, formations, |
| 145 | SNDRV_PCM_HW_PARAM_CHANNELS, -1); |
| 146 | if (err < 0) |
| 147 | goto end; |
| 148 | |
Takashi Sakamoto | bc8500d | 2015-09-19 11:21:57 +0900 | [diff] [blame] | 149 | err = amdtp_am824_add_pcm_hw_constraints(s, runtime); |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 150 | end: |
| 151 | return err; |
| 152 | } |
| 153 | |
| 154 | static int |
| 155 | pcm_open(struct snd_pcm_substream *substream) |
| 156 | { |
| 157 | struct snd_bebob *bebob = substream->private_data; |
Takashi Sakamoto | 1fc9522 | 2014-04-25 22:45:21 +0900 | [diff] [blame] | 158 | struct snd_bebob_rate_spec *spec = bebob->spec->rate; |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 159 | unsigned int sampling_rate; |
Takashi Sakamoto | 3e254b1 | 2015-06-14 12:49:30 +0900 | [diff] [blame] | 160 | enum snd_bebob_clock_type src; |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 161 | int err; |
| 162 | |
Takashi Sakamoto | 618eabe | 2014-04-25 22:45:20 +0900 | [diff] [blame] | 163 | err = snd_bebob_stream_lock_try(bebob); |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 164 | if (err < 0) |
| 165 | goto end; |
| 166 | |
Takashi Sakamoto | 618eabe | 2014-04-25 22:45:20 +0900 | [diff] [blame] | 167 | err = pcm_init_hw_params(bebob, substream); |
| 168 | if (err < 0) |
| 169 | goto err_locked; |
| 170 | |
Takashi Sakamoto | 3e254b1 | 2015-06-14 12:49:30 +0900 | [diff] [blame] | 171 | err = snd_bebob_stream_get_clock_src(bebob, &src); |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 172 | if (err < 0) |
Takashi Sakamoto | 618eabe | 2014-04-25 22:45:20 +0900 | [diff] [blame] | 173 | goto err_locked; |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 174 | |
| 175 | /* |
| 176 | * When source of clock is internal or any PCM stream are running, |
| 177 | * the available sampling rate is limited at current sampling rate. |
| 178 | */ |
Takashi Sakamoto | 3e254b1 | 2015-06-14 12:49:30 +0900 | [diff] [blame] | 179 | if (src == SND_BEBOB_CLOCK_TYPE_EXTERNAL || |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 180 | amdtp_stream_pcm_running(&bebob->tx_stream) || |
| 181 | amdtp_stream_pcm_running(&bebob->rx_stream)) { |
Takashi Sakamoto | 1fc9522 | 2014-04-25 22:45:21 +0900 | [diff] [blame] | 182 | err = spec->get(bebob, &sampling_rate); |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 183 | if (err < 0) { |
| 184 | dev_err(&bebob->unit->device, |
| 185 | "fail to get sampling rate: %d\n", err); |
Takashi Sakamoto | 618eabe | 2014-04-25 22:45:20 +0900 | [diff] [blame] | 186 | goto err_locked; |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 187 | } |
| 188 | |
| 189 | substream->runtime->hw.rate_min = sampling_rate; |
| 190 | substream->runtime->hw.rate_max = sampling_rate; |
| 191 | } |
| 192 | |
| 193 | snd_pcm_set_sync(substream); |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 194 | end: |
| 195 | return err; |
Takashi Sakamoto | 618eabe | 2014-04-25 22:45:20 +0900 | [diff] [blame] | 196 | err_locked: |
| 197 | snd_bebob_stream_lock_release(bebob); |
| 198 | return err; |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 199 | } |
| 200 | |
| 201 | static int |
| 202 | pcm_close(struct snd_pcm_substream *substream) |
| 203 | { |
Takashi Sakamoto | 618eabe | 2014-04-25 22:45:20 +0900 | [diff] [blame] | 204 | struct snd_bebob *bebob = substream->private_data; |
| 205 | snd_bebob_stream_lock_release(bebob); |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 206 | return 0; |
| 207 | } |
| 208 | |
| 209 | static int |
| 210 | pcm_capture_hw_params(struct snd_pcm_substream *substream, |
| 211 | struct snd_pcm_hw_params *hw_params) |
| 212 | { |
| 213 | struct snd_bebob *bebob = substream->private_data; |
Takashi Sakamoto | 22c103c | 2015-08-29 10:38:46 +0900 | [diff] [blame] | 214 | int err; |
| 215 | |
| 216 | err = snd_pcm_lib_alloc_vmalloc_buffer(substream, |
| 217 | params_buffer_bytes(hw_params)); |
| 218 | if (err < 0) |
| 219 | return err; |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 220 | |
| 221 | if (substream->runtime->status->state == SNDRV_PCM_STATE_OPEN) |
Takashi Sakamoto | 8d1c269 | 2015-06-14 12:49:36 +0900 | [diff] [blame] | 222 | atomic_inc(&bebob->substreams_counter); |
Takashi Sakamoto | 85130cb | 2015-09-19 11:22:00 +0900 | [diff] [blame^] | 223 | |
| 224 | amdtp_am824_set_pcm_format(&bebob->tx_stream, params_format(hw_params)); |
Takashi Sakamoto | 22c103c | 2015-08-29 10:38:46 +0900 | [diff] [blame] | 225 | |
| 226 | return 0; |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 227 | } |
| 228 | static int |
| 229 | pcm_playback_hw_params(struct snd_pcm_substream *substream, |
| 230 | struct snd_pcm_hw_params *hw_params) |
| 231 | { |
| 232 | struct snd_bebob *bebob = substream->private_data; |
Takashi Sakamoto | 22c103c | 2015-08-29 10:38:46 +0900 | [diff] [blame] | 233 | int err; |
| 234 | |
| 235 | err = snd_pcm_lib_alloc_vmalloc_buffer(substream, |
| 236 | params_buffer_bytes(hw_params)); |
| 237 | if (err < 0) |
| 238 | return err; |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 239 | |
| 240 | if (substream->runtime->status->state == SNDRV_PCM_STATE_OPEN) |
Takashi Sakamoto | 8d1c269 | 2015-06-14 12:49:36 +0900 | [diff] [blame] | 241 | atomic_inc(&bebob->substreams_counter); |
Takashi Sakamoto | 85130cb | 2015-09-19 11:22:00 +0900 | [diff] [blame^] | 242 | |
| 243 | amdtp_am824_set_pcm_format(&bebob->rx_stream, params_format(hw_params)); |
Takashi Sakamoto | 22c103c | 2015-08-29 10:38:46 +0900 | [diff] [blame] | 244 | |
| 245 | return 0; |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 246 | } |
| 247 | |
| 248 | static int |
| 249 | pcm_capture_hw_free(struct snd_pcm_substream *substream) |
| 250 | { |
| 251 | struct snd_bebob *bebob = substream->private_data; |
| 252 | |
| 253 | if (substream->runtime->status->state != SNDRV_PCM_STATE_OPEN) |
Takashi Sakamoto | 8d1c269 | 2015-06-14 12:49:36 +0900 | [diff] [blame] | 254 | atomic_dec(&bebob->substreams_counter); |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 255 | |
| 256 | snd_bebob_stream_stop_duplex(bebob); |
| 257 | |
| 258 | return snd_pcm_lib_free_vmalloc_buffer(substream); |
| 259 | } |
| 260 | static int |
| 261 | pcm_playback_hw_free(struct snd_pcm_substream *substream) |
| 262 | { |
| 263 | struct snd_bebob *bebob = substream->private_data; |
| 264 | |
| 265 | if (substream->runtime->status->state != SNDRV_PCM_STATE_OPEN) |
Takashi Sakamoto | 8d1c269 | 2015-06-14 12:49:36 +0900 | [diff] [blame] | 266 | atomic_dec(&bebob->substreams_counter); |
Takashi Sakamoto | fbbebd2 | 2014-04-25 22:45:19 +0900 | [diff] [blame] | 267 | |
| 268 | snd_bebob_stream_stop_duplex(bebob); |
| 269 | |
| 270 | return snd_pcm_lib_free_vmalloc_buffer(substream); |
| 271 | } |
| 272 | |
| 273 | static int |
| 274 | pcm_capture_prepare(struct snd_pcm_substream *substream) |
| 275 | { |
| 276 | struct snd_bebob *bebob = substream->private_data; |
| 277 | struct snd_pcm_runtime *runtime = substream->runtime; |
| 278 | int err; |
| 279 | |
| 280 | err = snd_bebob_stream_start_duplex(bebob, runtime->rate); |
| 281 | if (err >= 0) |
| 282 | amdtp_stream_pcm_prepare(&bebob->tx_stream); |
| 283 | |
| 284 | return err; |
| 285 | } |
| 286 | static int |
| 287 | pcm_playback_prepare(struct snd_pcm_substream *substream) |
| 288 | { |
| 289 | struct snd_bebob *bebob = substream->private_data; |
| 290 | struct snd_pcm_runtime *runtime = substream->runtime; |
| 291 | int err; |
| 292 | |
| 293 | err = snd_bebob_stream_start_duplex(bebob, runtime->rate); |
| 294 | if (err >= 0) |
| 295 | amdtp_stream_pcm_prepare(&bebob->rx_stream); |
| 296 | |
| 297 | return err; |
| 298 | } |
| 299 | |
| 300 | static int |
| 301 | pcm_capture_trigger(struct snd_pcm_substream *substream, int cmd) |
| 302 | { |
| 303 | struct snd_bebob *bebob = substream->private_data; |
| 304 | |
| 305 | switch (cmd) { |
| 306 | case SNDRV_PCM_TRIGGER_START: |
| 307 | amdtp_stream_pcm_trigger(&bebob->tx_stream, substream); |
| 308 | break; |
| 309 | case SNDRV_PCM_TRIGGER_STOP: |
| 310 | amdtp_stream_pcm_trigger(&bebob->tx_stream, NULL); |
| 311 | break; |
| 312 | default: |
| 313 | return -EINVAL; |
| 314 | } |
| 315 | |
| 316 | return 0; |
| 317 | } |
| 318 | static int |
| 319 | pcm_playback_trigger(struct snd_pcm_substream *substream, int cmd) |
| 320 | { |
| 321 | struct snd_bebob *bebob = substream->private_data; |
| 322 | |
| 323 | switch (cmd) { |
| 324 | case SNDRV_PCM_TRIGGER_START: |
| 325 | amdtp_stream_pcm_trigger(&bebob->rx_stream, substream); |
| 326 | break; |
| 327 | case SNDRV_PCM_TRIGGER_STOP: |
| 328 | amdtp_stream_pcm_trigger(&bebob->rx_stream, NULL); |
| 329 | break; |
| 330 | default: |
| 331 | return -EINVAL; |
| 332 | } |
| 333 | |
| 334 | return 0; |
| 335 | } |
| 336 | |
| 337 | static snd_pcm_uframes_t |
| 338 | pcm_capture_pointer(struct snd_pcm_substream *sbstrm) |
| 339 | { |
| 340 | struct snd_bebob *bebob = sbstrm->private_data; |
| 341 | return amdtp_stream_pcm_pointer(&bebob->tx_stream); |
| 342 | } |
| 343 | static snd_pcm_uframes_t |
| 344 | pcm_playback_pointer(struct snd_pcm_substream *sbstrm) |
| 345 | { |
| 346 | struct snd_bebob *bebob = sbstrm->private_data; |
| 347 | return amdtp_stream_pcm_pointer(&bebob->rx_stream); |
| 348 | } |
| 349 | |
| 350 | static const struct snd_pcm_ops pcm_capture_ops = { |
| 351 | .open = pcm_open, |
| 352 | .close = pcm_close, |
| 353 | .ioctl = snd_pcm_lib_ioctl, |
| 354 | .hw_params = pcm_capture_hw_params, |
| 355 | .hw_free = pcm_capture_hw_free, |
| 356 | .prepare = pcm_capture_prepare, |
| 357 | .trigger = pcm_capture_trigger, |
| 358 | .pointer = pcm_capture_pointer, |
| 359 | .page = snd_pcm_lib_get_vmalloc_page, |
| 360 | }; |
| 361 | static const struct snd_pcm_ops pcm_playback_ops = { |
| 362 | .open = pcm_open, |
| 363 | .close = pcm_close, |
| 364 | .ioctl = snd_pcm_lib_ioctl, |
| 365 | .hw_params = pcm_playback_hw_params, |
| 366 | .hw_free = pcm_playback_hw_free, |
| 367 | .prepare = pcm_playback_prepare, |
| 368 | .trigger = pcm_playback_trigger, |
| 369 | .pointer = pcm_playback_pointer, |
| 370 | .page = snd_pcm_lib_get_vmalloc_page, |
| 371 | .mmap = snd_pcm_lib_mmap_vmalloc, |
| 372 | }; |
| 373 | |
| 374 | int snd_bebob_create_pcm_devices(struct snd_bebob *bebob) |
| 375 | { |
| 376 | struct snd_pcm *pcm; |
| 377 | int err; |
| 378 | |
| 379 | err = snd_pcm_new(bebob->card, bebob->card->driver, 0, 1, 1, &pcm); |
| 380 | if (err < 0) |
| 381 | goto end; |
| 382 | |
| 383 | pcm->private_data = bebob; |
| 384 | snprintf(pcm->name, sizeof(pcm->name), |
| 385 | "%s PCM", bebob->card->shortname); |
| 386 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &pcm_playback_ops); |
| 387 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &pcm_capture_ops); |
| 388 | end: |
| 389 | return err; |
| 390 | } |