1 // SPDX-License-Identifier: GPL-2.0-only
3 * motu-stream.c - a part of driver for MOTU FireWire series
5 * Copyright (c) 2015-2017 Takashi Sakamoto <o-takashi@sakamocchi.jp>
10 #define READY_TIMEOUT_MS 200
12 #define ISOC_COMM_CONTROL_OFFSET 0x0b00
13 #define ISOC_COMM_CONTROL_MASK 0xffff0000
14 #define CHANGE_RX_ISOC_COMM_STATE 0x80000000
15 #define RX_ISOC_COMM_IS_ACTIVATED 0x40000000
16 #define RX_ISOC_COMM_CHANNEL_MASK 0x3f000000
17 #define RX_ISOC_COMM_CHANNEL_SHIFT 24
18 #define CHANGE_TX_ISOC_COMM_STATE 0x00800000
19 #define TX_ISOC_COMM_IS_ACTIVATED 0x00400000
20 #define TX_ISOC_COMM_CHANNEL_MASK 0x003f0000
21 #define TX_ISOC_COMM_CHANNEL_SHIFT 16
23 #define PACKET_FORMAT_OFFSET 0x0b10
24 #define TX_PACKET_EXCLUDE_DIFFERED_DATA_CHUNKS 0x00000080
25 #define RX_PACKET_EXCLUDE_DIFFERED_DATA_CHUNKS 0x00000040
26 #define TX_PACKET_TRANSMISSION_SPEED_MASK 0x0000000f
28 static int keep_resources(struct snd_motu *motu, unsigned int rate,
29 struct amdtp_stream *stream)
31 struct fw_iso_resources *resources;
32 struct snd_motu_packet_format *packet_format;
33 unsigned int midi_ports = 0;
36 if (stream == &motu->rx_stream) {
37 resources = &motu->rx_resources;
38 packet_format = &motu->rx_packet_formats;
40 if ((motu->spec->flags & SND_MOTU_SPEC_RX_MIDI_2ND_Q) ||
41 (motu->spec->flags & SND_MOTU_SPEC_RX_MIDI_3RD_Q))
44 resources = &motu->tx_resources;
45 packet_format = &motu->tx_packet_formats;
47 if ((motu->spec->flags & SND_MOTU_SPEC_TX_MIDI_2ND_Q) ||
48 (motu->spec->flags & SND_MOTU_SPEC_TX_MIDI_3RD_Q))
52 err = amdtp_motu_set_parameters(stream, rate, midi_ports,
57 return fw_iso_resources_allocate(resources,
58 amdtp_stream_get_max_payload(stream),
59 fw_parent_device(motu->unit)->max_speed);
62 static int begin_session(struct snd_motu *motu)
68 // Configure the unit to start isochronous communication.
69 err = snd_motu_transaction_read(motu, ISOC_COMM_CONTROL_OFFSET, ®,
73 data = be32_to_cpu(reg) & ~ISOC_COMM_CONTROL_MASK;
75 data |= CHANGE_RX_ISOC_COMM_STATE | RX_ISOC_COMM_IS_ACTIVATED |
76 (motu->rx_resources.channel << RX_ISOC_COMM_CHANNEL_SHIFT) |
77 CHANGE_TX_ISOC_COMM_STATE | TX_ISOC_COMM_IS_ACTIVATED |
78 (motu->tx_resources.channel << TX_ISOC_COMM_CHANNEL_SHIFT);
80 reg = cpu_to_be32(data);
81 return snd_motu_transaction_write(motu, ISOC_COMM_CONTROL_OFFSET, ®,
85 static void finish_session(struct snd_motu *motu)
91 err = snd_motu_protocol_switch_fetching_mode(motu, false);
95 err = snd_motu_transaction_read(motu, ISOC_COMM_CONTROL_OFFSET, ®,
99 data = be32_to_cpu(reg);
101 data &= ~(RX_ISOC_COMM_IS_ACTIVATED | TX_ISOC_COMM_IS_ACTIVATED);
102 data |= CHANGE_RX_ISOC_COMM_STATE | CHANGE_TX_ISOC_COMM_STATE;
104 reg = cpu_to_be32(data);
105 snd_motu_transaction_write(motu, ISOC_COMM_CONTROL_OFFSET, ®,
109 int snd_motu_stream_cache_packet_formats(struct snd_motu *motu)
113 err = snd_motu_protocol_cache_packet_formats(motu);
117 if (motu->spec->flags & SND_MOTU_SPEC_TX_MIDI_2ND_Q) {
118 motu->tx_packet_formats.midi_flag_offset = 4;
119 motu->tx_packet_formats.midi_byte_offset = 6;
120 } else if (motu->spec->flags & SND_MOTU_SPEC_TX_MIDI_3RD_Q) {
121 motu->tx_packet_formats.midi_flag_offset = 8;
122 motu->tx_packet_formats.midi_byte_offset = 7;
125 if (motu->spec->flags & SND_MOTU_SPEC_RX_MIDI_2ND_Q) {
126 motu->rx_packet_formats.midi_flag_offset = 4;
127 motu->rx_packet_formats.midi_byte_offset = 6;
128 } else if (motu->spec->flags & SND_MOTU_SPEC_RX_MIDI_3RD_Q) {
129 motu->rx_packet_formats.midi_flag_offset = 8;
130 motu->rx_packet_formats.midi_byte_offset = 7;
136 int snd_motu_stream_reserve_duplex(struct snd_motu *motu, unsigned int rate,
137 unsigned int frames_per_period,
138 unsigned int frames_per_buffer)
140 unsigned int curr_rate;
143 err = snd_motu_protocol_get_clock_rate(motu, &curr_rate);
149 if (motu->substreams_counter == 0 || curr_rate != rate) {
150 amdtp_domain_stop(&motu->domain);
151 finish_session(motu);
153 fw_iso_resources_free(&motu->tx_resources);
154 fw_iso_resources_free(&motu->rx_resources);
156 kfree(motu->cache.event_offsets);
157 motu->cache.event_offsets = NULL;
159 err = snd_motu_protocol_set_clock_rate(motu, rate);
161 dev_err(&motu->unit->device,
162 "fail to set sampling rate: %d\n", err);
166 err = snd_motu_stream_cache_packet_formats(motu);
170 err = keep_resources(motu, rate, &motu->tx_stream);
174 err = keep_resources(motu, rate, &motu->rx_stream);
176 fw_iso_resources_free(&motu->tx_resources);
180 err = amdtp_domain_set_events_per_period(&motu->domain,
181 frames_per_period, frames_per_buffer);
183 fw_iso_resources_free(&motu->tx_resources);
184 fw_iso_resources_free(&motu->rx_resources);
188 motu->cache.size = motu->tx_stream.syt_interval * frames_per_buffer;
189 motu->cache.event_offsets = kcalloc(motu->cache.size, sizeof(*motu->cache.event_offsets),
191 if (!motu->cache.event_offsets) {
192 fw_iso_resources_free(&motu->tx_resources);
193 fw_iso_resources_free(&motu->rx_resources);
201 static int ensure_packet_formats(struct snd_motu *motu)
207 err = snd_motu_transaction_read(motu, PACKET_FORMAT_OFFSET, ®,
211 data = be32_to_cpu(reg);
213 data &= ~(TX_PACKET_EXCLUDE_DIFFERED_DATA_CHUNKS |
214 RX_PACKET_EXCLUDE_DIFFERED_DATA_CHUNKS|
215 TX_PACKET_TRANSMISSION_SPEED_MASK);
216 if (motu->spec->tx_fixed_pcm_chunks[0] == motu->tx_packet_formats.pcm_chunks[0])
217 data |= TX_PACKET_EXCLUDE_DIFFERED_DATA_CHUNKS;
218 if (motu->spec->rx_fixed_pcm_chunks[0] == motu->rx_packet_formats.pcm_chunks[0])
219 data |= RX_PACKET_EXCLUDE_DIFFERED_DATA_CHUNKS;
220 data |= fw_parent_device(motu->unit)->max_speed;
222 reg = cpu_to_be32(data);
223 return snd_motu_transaction_write(motu, PACKET_FORMAT_OFFSET, ®,
227 int snd_motu_stream_start_duplex(struct snd_motu *motu)
229 unsigned int generation = motu->rx_resources.generation;
232 if (motu->substreams_counter == 0)
235 if (amdtp_streaming_error(&motu->rx_stream) ||
236 amdtp_streaming_error(&motu->tx_stream)) {
237 amdtp_domain_stop(&motu->domain);
238 finish_session(motu);
241 if (generation != fw_parent_device(motu->unit)->card->generation) {
242 err = fw_iso_resources_update(&motu->rx_resources);
246 err = fw_iso_resources_update(&motu->tx_resources);
251 if (!amdtp_stream_running(&motu->rx_stream)) {
252 int spd = fw_parent_device(motu->unit)->max_speed;
254 err = ensure_packet_formats(motu);
258 if (motu->spec->flags & SND_MOTU_SPEC_REGISTER_DSP) {
259 err = snd_motu_register_dsp_message_parser_init(motu);
262 } else if (motu->spec->flags & SND_MOTU_SPEC_COMMAND_DSP) {
263 err = snd_motu_command_dsp_message_parser_init(motu, motu->tx_stream.sfc);
268 err = begin_session(motu);
270 dev_err(&motu->unit->device,
271 "fail to start isochronous comm: %d\n", err);
275 err = amdtp_domain_add_stream(&motu->domain, &motu->tx_stream,
276 motu->tx_resources.channel, spd);
280 err = amdtp_domain_add_stream(&motu->domain, &motu->rx_stream,
281 motu->rx_resources.channel, spd);
285 motu->cache.tail = 0;
286 motu->cache.tx_cycle_count = UINT_MAX;
287 motu->cache.head = 0;
288 motu->cache.rx_cycle_count = UINT_MAX;
290 // NOTE: The device requires both of replay; the sequence of the number of data
291 // blocks per packet, and the sequence of source packet header per data block as
292 // presentation time.
293 err = amdtp_domain_start(&motu->domain, 0, true, false);
297 if (!amdtp_domain_wait_ready(&motu->domain, READY_TIMEOUT_MS)) {
302 err = snd_motu_protocol_switch_fetching_mode(motu, true);
304 dev_err(&motu->unit->device,
305 "fail to enable frame fetching: %d\n", err);
313 amdtp_domain_stop(&motu->domain);
314 finish_session(motu);
318 void snd_motu_stream_stop_duplex(struct snd_motu *motu)
320 if (motu->substreams_counter == 0) {
321 amdtp_domain_stop(&motu->domain);
322 finish_session(motu);
324 fw_iso_resources_free(&motu->tx_resources);
325 fw_iso_resources_free(&motu->rx_resources);
327 kfree(motu->cache.event_offsets);
328 motu->cache.event_offsets = NULL;
332 static int init_stream(struct snd_motu *motu, struct amdtp_stream *s)
334 struct fw_iso_resources *resources;
335 enum amdtp_stream_direction dir;
338 if (s == &motu->tx_stream) {
339 resources = &motu->tx_resources;
340 dir = AMDTP_IN_STREAM;
342 resources = &motu->rx_resources;
343 dir = AMDTP_OUT_STREAM;
346 err = fw_iso_resources_init(resources, motu->unit);
350 err = amdtp_motu_init(s, motu->unit, dir, motu->spec, &motu->cache);
352 fw_iso_resources_destroy(resources);
357 static void destroy_stream(struct snd_motu *motu, struct amdtp_stream *s)
359 amdtp_stream_destroy(s);
361 if (s == &motu->tx_stream)
362 fw_iso_resources_destroy(&motu->tx_resources);
364 fw_iso_resources_destroy(&motu->rx_resources);
367 int snd_motu_stream_init_duplex(struct snd_motu *motu)
371 err = init_stream(motu, &motu->tx_stream);
375 err = init_stream(motu, &motu->rx_stream);
377 destroy_stream(motu, &motu->tx_stream);
381 err = amdtp_domain_init(&motu->domain);
383 destroy_stream(motu, &motu->tx_stream);
384 destroy_stream(motu, &motu->rx_stream);
390 // This function should be called before starting streams or after stopping
392 void snd_motu_stream_destroy_duplex(struct snd_motu *motu)
394 amdtp_domain_destroy(&motu->domain);
396 destroy_stream(motu, &motu->rx_stream);
397 destroy_stream(motu, &motu->tx_stream);
399 motu->substreams_counter = 0;
402 static void motu_lock_changed(struct snd_motu *motu)
404 motu->dev_lock_changed = true;
405 wake_up(&motu->hwdep_wait);
408 int snd_motu_stream_lock_try(struct snd_motu *motu)
412 spin_lock_irq(&motu->lock);
414 if (motu->dev_lock_count < 0) {
419 if (motu->dev_lock_count++ == 0)
420 motu_lock_changed(motu);
423 spin_unlock_irq(&motu->lock);
427 void snd_motu_stream_lock_release(struct snd_motu *motu)
429 spin_lock_irq(&motu->lock);
431 if (WARN_ON(motu->dev_lock_count <= 0))
434 if (--motu->dev_lock_count == 0)
435 motu_lock_changed(motu);
437 spin_unlock_irq(&motu->lock);