1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * motu-pcm.c - a part of driver for MOTU FireWire series 4 * 5 * Copyright (c) 2015-2017 Takashi Sakamoto <o-takashi@sakamocchi.jp> 6 */ 7 8 #include <sound/pcm_params.h> 9 #include "motu.h" 10 11 static int motu_rate_constraint(struct snd_pcm_hw_params *params, 12 struct snd_pcm_hw_rule *rule) 13 { 14 struct snd_motu_packet_format *formats = rule->private; 15 16 const struct snd_interval *c = 17 hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_CHANNELS); 18 struct snd_interval *r = 19 hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); 20 struct snd_interval rates = { 21 .min = UINT_MAX, .max = 0, .integer = 1 22 }; 23 unsigned int i, pcm_channels, rate, mode; 24 25 for (i = 0; i < ARRAY_SIZE(snd_motu_clock_rates); ++i) { 26 rate = snd_motu_clock_rates[i]; 27 mode = i / 2; 28 29 pcm_channels = formats->fixed_part_pcm_chunks[mode] + 30 formats->differed_part_pcm_chunks[mode]; 31 if (!snd_interval_test(c, pcm_channels)) 32 continue; 33 34 rates.min = min(rates.min, rate); 35 rates.max = max(rates.max, rate); 36 } 37 38 return snd_interval_refine(r, &rates); 39 } 40 41 static int motu_channels_constraint(struct snd_pcm_hw_params *params, 42 struct snd_pcm_hw_rule *rule) 43 { 44 struct snd_motu_packet_format *formats = rule->private; 45 46 const struct snd_interval *r = 47 hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_RATE); 48 struct snd_interval *c = 49 hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); 50 struct snd_interval channels = { 51 .min = UINT_MAX, .max = 0, .integer = 1 52 }; 53 unsigned int i, pcm_channels, rate, mode; 54 55 for (i = 0; i < ARRAY_SIZE(snd_motu_clock_rates); ++i) { 56 rate = snd_motu_clock_rates[i]; 57 mode = i / 2; 58 59 if (!snd_interval_test(r, rate)) 60 continue; 61 62 pcm_channels = formats->fixed_part_pcm_chunks[mode] + 63 formats->differed_part_pcm_chunks[mode]; 64 channels.min = min(channels.min, pcm_channels); 65 channels.max = max(channels.max, pcm_channels); 66 } 67 68 return snd_interval_refine(c, &channels); 69 } 70 71 static void limit_channels_and_rates(struct snd_motu *motu, 72 struct snd_pcm_runtime *runtime, 73 struct snd_motu_packet_format *formats) 74 { 75 struct snd_pcm_hardware *hw = &runtime->hw; 76 unsigned int i, pcm_channels, rate, mode; 77 78 hw->channels_min = UINT_MAX; 79 hw->channels_max = 0; 80 81 for (i = 0; i < ARRAY_SIZE(snd_motu_clock_rates); ++i) { 82 rate = snd_motu_clock_rates[i]; 83 mode = i / 2; 84 85 pcm_channels = formats->fixed_part_pcm_chunks[mode] + 86 formats->differed_part_pcm_chunks[mode]; 87 if (pcm_channels == 0) 88 continue; 89 90 hw->rates |= snd_pcm_rate_to_rate_bit(rate); 91 hw->channels_min = min(hw->channels_min, pcm_channels); 92 hw->channels_max = max(hw->channels_max, pcm_channels); 93 } 94 95 snd_pcm_limit_hw_rates(runtime); 96 } 97 98 static int init_hw_info(struct snd_motu *motu, 99 struct snd_pcm_substream *substream) 100 { 101 struct snd_pcm_runtime *runtime = substream->runtime; 102 struct snd_pcm_hardware *hw = &runtime->hw; 103 struct amdtp_stream *stream; 104 struct snd_motu_packet_format *formats; 105 int err; 106 107 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) { 108 hw->formats = SNDRV_PCM_FMTBIT_S32; 109 stream = &motu->tx_stream; 110 formats = &motu->tx_packet_formats; 111 } else { 112 hw->formats = SNDRV_PCM_FMTBIT_S32; 113 stream = &motu->rx_stream; 114 formats = &motu->rx_packet_formats; 115 } 116 117 limit_channels_and_rates(motu, runtime, formats); 118 119 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, 120 motu_rate_constraint, formats, 121 SNDRV_PCM_HW_PARAM_CHANNELS, -1); 122 if (err < 0) 123 return err; 124 err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS, 125 motu_channels_constraint, formats, 126 SNDRV_PCM_HW_PARAM_RATE, -1); 127 if (err < 0) 128 return err; 129 130 return amdtp_motu_add_pcm_hw_constraints(stream, runtime); 131 } 132 133 static int pcm_open(struct snd_pcm_substream *substream) 134 { 135 struct snd_motu *motu = substream->private_data; 136 const struct snd_motu_protocol *const protocol = motu->spec->protocol; 137 struct amdtp_domain *d = &motu->domain; 138 enum snd_motu_clock_source src; 139 int err; 140 141 err = snd_motu_stream_lock_try(motu); 142 if (err < 0) 143 return err; 144 145 mutex_lock(&motu->mutex); 146 147 err = snd_motu_stream_cache_packet_formats(motu); 148 if (err < 0) 149 goto err_locked; 150 151 err = init_hw_info(motu, substream); 152 if (err < 0) 153 goto err_locked; 154 155 err = protocol->get_clock_source(motu, &src); 156 if (err < 0) 157 goto err_locked; 158 159 // When source of clock is not internal or any stream is reserved for 160 // transmission of PCM frames, the available sampling rate is limited 161 // at current one. 162 if ((src != SND_MOTU_CLOCK_SOURCE_INTERNAL && 163 src != SND_MOTU_CLOCK_SOURCE_SPH) || 164 (motu->substreams_counter > 0 && d->events_per_period > 0)) { 165 unsigned int frames_per_period = d->events_per_period; 166 unsigned int frames_per_buffer = d->events_per_buffer; 167 unsigned int rate; 168 169 err = protocol->get_clock_rate(motu, &rate); 170 if (err < 0) 171 goto err_locked; 172 173 substream->runtime->hw.rate_min = rate; 174 substream->runtime->hw.rate_max = rate; 175 176 if (frames_per_period > 0) { 177 err = snd_pcm_hw_constraint_minmax(substream->runtime, 178 SNDRV_PCM_HW_PARAM_PERIOD_SIZE, 179 frames_per_period, frames_per_period); 180 if (err < 0) { 181 mutex_unlock(&motu->mutex); 182 goto err_locked; 183 } 184 185 err = snd_pcm_hw_constraint_minmax(substream->runtime, 186 SNDRV_PCM_HW_PARAM_BUFFER_SIZE, 187 frames_per_buffer, frames_per_buffer); 188 if (err < 0) { 189 mutex_unlock(&motu->mutex); 190 goto err_locked; 191 } 192 } 193 } 194 195 snd_pcm_set_sync(substream); 196 197 mutex_unlock(&motu->mutex); 198 199 return 0; 200 err_locked: 201 mutex_unlock(&motu->mutex); 202 snd_motu_stream_lock_release(motu); 203 return err; 204 } 205 206 static int pcm_close(struct snd_pcm_substream *substream) 207 { 208 struct snd_motu *motu = substream->private_data; 209 210 snd_motu_stream_lock_release(motu); 211 212 return 0; 213 } 214 215 static int pcm_hw_params(struct snd_pcm_substream *substream, 216 struct snd_pcm_hw_params *hw_params) 217 { 218 struct snd_motu *motu = substream->private_data; 219 int err; 220 221 err = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(hw_params)); 222 if (err < 0) 223 return err; 224 225 if (substream->runtime->status->state == SNDRV_PCM_STATE_OPEN) { 226 unsigned int rate = params_rate(hw_params); 227 unsigned int frames_per_period = params_period_size(hw_params); 228 unsigned int frames_per_buffer = params_buffer_size(hw_params); 229 230 mutex_lock(&motu->mutex); 231 err = snd_motu_stream_reserve_duplex(motu, rate, 232 frames_per_period, frames_per_buffer); 233 if (err >= 0) 234 ++motu->substreams_counter; 235 mutex_unlock(&motu->mutex); 236 } 237 238 return err; 239 } 240 241 static int pcm_hw_free(struct snd_pcm_substream *substream) 242 { 243 struct snd_motu *motu = substream->private_data; 244 245 mutex_lock(&motu->mutex); 246 247 if (substream->runtime->status->state != SNDRV_PCM_STATE_OPEN) 248 --motu->substreams_counter; 249 250 snd_motu_stream_stop_duplex(motu); 251 252 mutex_unlock(&motu->mutex); 253 254 return snd_pcm_lib_free_pages(substream); 255 } 256 257 static int capture_prepare(struct snd_pcm_substream *substream) 258 { 259 struct snd_motu *motu = substream->private_data; 260 int err; 261 262 mutex_lock(&motu->mutex); 263 err = snd_motu_stream_start_duplex(motu); 264 mutex_unlock(&motu->mutex); 265 if (err >= 0) 266 amdtp_stream_pcm_prepare(&motu->tx_stream); 267 268 return 0; 269 } 270 static int playback_prepare(struct snd_pcm_substream *substream) 271 { 272 struct snd_motu *motu = substream->private_data; 273 int err; 274 275 mutex_lock(&motu->mutex); 276 err = snd_motu_stream_start_duplex(motu); 277 mutex_unlock(&motu->mutex); 278 if (err >= 0) 279 amdtp_stream_pcm_prepare(&motu->rx_stream); 280 281 return err; 282 } 283 284 static int capture_trigger(struct snd_pcm_substream *substream, int cmd) 285 { 286 struct snd_motu *motu = substream->private_data; 287 288 switch (cmd) { 289 case SNDRV_PCM_TRIGGER_START: 290 amdtp_stream_pcm_trigger(&motu->tx_stream, substream); 291 break; 292 case SNDRV_PCM_TRIGGER_STOP: 293 amdtp_stream_pcm_trigger(&motu->tx_stream, NULL); 294 break; 295 default: 296 return -EINVAL; 297 } 298 299 return 0; 300 } 301 static int playback_trigger(struct snd_pcm_substream *substream, int cmd) 302 { 303 struct snd_motu *motu = substream->private_data; 304 305 switch (cmd) { 306 case SNDRV_PCM_TRIGGER_START: 307 amdtp_stream_pcm_trigger(&motu->rx_stream, substream); 308 break; 309 case SNDRV_PCM_TRIGGER_STOP: 310 amdtp_stream_pcm_trigger(&motu->rx_stream, NULL); 311 break; 312 default: 313 return -EINVAL; 314 } 315 316 return 0; 317 } 318 319 static snd_pcm_uframes_t capture_pointer(struct snd_pcm_substream *substream) 320 { 321 struct snd_motu *motu = substream->private_data; 322 323 return amdtp_domain_stream_pcm_pointer(&motu->domain, &motu->tx_stream); 324 } 325 static snd_pcm_uframes_t playback_pointer(struct snd_pcm_substream *substream) 326 { 327 struct snd_motu *motu = substream->private_data; 328 329 return amdtp_domain_stream_pcm_pointer(&motu->domain, &motu->rx_stream); 330 } 331 332 static int capture_ack(struct snd_pcm_substream *substream) 333 { 334 struct snd_motu *motu = substream->private_data; 335 336 return amdtp_domain_stream_pcm_ack(&motu->domain, &motu->tx_stream); 337 } 338 339 static int playback_ack(struct snd_pcm_substream *substream) 340 { 341 struct snd_motu *motu = substream->private_data; 342 343 return amdtp_domain_stream_pcm_ack(&motu->domain, &motu->rx_stream); 344 } 345 346 int snd_motu_create_pcm_devices(struct snd_motu *motu) 347 { 348 static const struct snd_pcm_ops capture_ops = { 349 .open = pcm_open, 350 .close = pcm_close, 351 .ioctl = snd_pcm_lib_ioctl, 352 .hw_params = pcm_hw_params, 353 .hw_free = pcm_hw_free, 354 .prepare = capture_prepare, 355 .trigger = capture_trigger, 356 .pointer = capture_pointer, 357 .ack = capture_ack, 358 }; 359 static const struct snd_pcm_ops playback_ops = { 360 .open = pcm_open, 361 .close = pcm_close, 362 .ioctl = snd_pcm_lib_ioctl, 363 .hw_params = pcm_hw_params, 364 .hw_free = pcm_hw_free, 365 .prepare = playback_prepare, 366 .trigger = playback_trigger, 367 .pointer = playback_pointer, 368 .ack = playback_ack, 369 }; 370 struct snd_pcm *pcm; 371 int err; 372 373 err = snd_pcm_new(motu->card, motu->card->driver, 0, 1, 1, &pcm); 374 if (err < 0) 375 return err; 376 pcm->private_data = motu; 377 strcpy(pcm->name, motu->card->shortname); 378 379 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &capture_ops); 380 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &playback_ops); 381 snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_VMALLOC, 382 NULL, 0, 0); 383 384 return 0; 385 } 386