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 CALLBACK_TIMEOUT 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 = motu->spec->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 = motu->spec->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 = motu->spec->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 err = motu->spec->protocol->set_clock_rate(motu, rate);
158 dev_err(&motu->unit->device,
159 "fail to set sampling rate: %d\n", err);
163 err = snd_motu_stream_cache_packet_formats(motu);
167 err = keep_resources(motu, rate, &motu->tx_stream);
171 err = keep_resources(motu, rate, &motu->rx_stream);
173 fw_iso_resources_free(&motu->tx_resources);
177 err = amdtp_domain_set_events_per_period(&motu->domain,
178 frames_per_period, frames_per_buffer);
180 fw_iso_resources_free(&motu->tx_resources);
181 fw_iso_resources_free(&motu->rx_resources);
189 static int ensure_packet_formats(struct snd_motu *motu)
195 err = snd_motu_transaction_read(motu, PACKET_FORMAT_OFFSET, ®,
199 data = be32_to_cpu(reg);
201 data &= ~(TX_PACKET_EXCLUDE_DIFFERED_DATA_CHUNKS |
202 RX_PACKET_EXCLUDE_DIFFERED_DATA_CHUNKS|
203 TX_PACKET_TRANSMISSION_SPEED_MASK);
204 if (motu->tx_packet_formats.differed_part_pcm_chunks[0] == 0)
205 data |= TX_PACKET_EXCLUDE_DIFFERED_DATA_CHUNKS;
206 if (motu->rx_packet_formats.differed_part_pcm_chunks[0] == 0)
207 data |= RX_PACKET_EXCLUDE_DIFFERED_DATA_CHUNKS;
208 data |= fw_parent_device(motu->unit)->max_speed;
210 reg = cpu_to_be32(data);
211 return snd_motu_transaction_write(motu, PACKET_FORMAT_OFFSET, ®,
215 int snd_motu_stream_start_duplex(struct snd_motu *motu)
217 unsigned int generation = motu->rx_resources.generation;
220 if (motu->substreams_counter == 0)
223 if (amdtp_streaming_error(&motu->rx_stream) ||
224 amdtp_streaming_error(&motu->tx_stream)) {
225 amdtp_domain_stop(&motu->domain);
226 finish_session(motu);
229 if (generation != fw_parent_device(motu->unit)->card->generation) {
230 err = fw_iso_resources_update(&motu->rx_resources);
234 err = fw_iso_resources_update(&motu->tx_resources);
239 if (!amdtp_stream_running(&motu->rx_stream)) {
240 int spd = fw_parent_device(motu->unit)->max_speed;
242 err = ensure_packet_formats(motu);
246 err = begin_session(motu);
248 dev_err(&motu->unit->device,
249 "fail to start isochronous comm: %d\n", err);
253 err = amdtp_domain_add_stream(&motu->domain, &motu->tx_stream,
254 motu->tx_resources.channel, spd);
258 err = amdtp_domain_add_stream(&motu->domain, &motu->rx_stream,
259 motu->rx_resources.channel, spd);
263 err = amdtp_domain_start(&motu->domain, 0);
267 if (!amdtp_stream_wait_callback(&motu->tx_stream,
269 !amdtp_stream_wait_callback(&motu->rx_stream,
275 err = motu->spec->protocol->switch_fetching_mode(motu, true);
277 dev_err(&motu->unit->device,
278 "fail to enable frame fetching: %d\n", err);
286 amdtp_domain_stop(&motu->domain);
287 finish_session(motu);
291 void snd_motu_stream_stop_duplex(struct snd_motu *motu)
293 if (motu->substreams_counter == 0) {
294 amdtp_domain_stop(&motu->domain);
295 finish_session(motu);
297 fw_iso_resources_free(&motu->tx_resources);
298 fw_iso_resources_free(&motu->rx_resources);
302 static int init_stream(struct snd_motu *motu, struct amdtp_stream *s)
304 struct fw_iso_resources *resources;
305 enum amdtp_stream_direction dir;
308 if (s == &motu->tx_stream) {
309 resources = &motu->tx_resources;
310 dir = AMDTP_IN_STREAM;
312 resources = &motu->rx_resources;
313 dir = AMDTP_OUT_STREAM;
316 err = fw_iso_resources_init(resources, motu->unit);
320 err = amdtp_motu_init(s, motu->unit, dir, motu->spec->protocol);
322 fw_iso_resources_destroy(resources);
327 static void destroy_stream(struct snd_motu *motu, struct amdtp_stream *s)
329 amdtp_stream_destroy(s);
331 if (s == &motu->tx_stream)
332 fw_iso_resources_destroy(&motu->tx_resources);
334 fw_iso_resources_destroy(&motu->rx_resources);
337 int snd_motu_stream_init_duplex(struct snd_motu *motu)
341 err = init_stream(motu, &motu->tx_stream);
345 err = init_stream(motu, &motu->rx_stream);
347 destroy_stream(motu, &motu->tx_stream);
351 err = amdtp_domain_init(&motu->domain);
353 destroy_stream(motu, &motu->tx_stream);
354 destroy_stream(motu, &motu->rx_stream);
360 // This function should be called before starting streams or after stopping
362 void snd_motu_stream_destroy_duplex(struct snd_motu *motu)
364 amdtp_domain_destroy(&motu->domain);
366 destroy_stream(motu, &motu->rx_stream);
367 destroy_stream(motu, &motu->tx_stream);
369 motu->substreams_counter = 0;
372 static void motu_lock_changed(struct snd_motu *motu)
374 motu->dev_lock_changed = true;
375 wake_up(&motu->hwdep_wait);
378 int snd_motu_stream_lock_try(struct snd_motu *motu)
382 spin_lock_irq(&motu->lock);
384 if (motu->dev_lock_count < 0) {
389 if (motu->dev_lock_count++ == 0)
390 motu_lock_changed(motu);
393 spin_unlock_irq(&motu->lock);
397 void snd_motu_stream_lock_release(struct snd_motu *motu)
399 spin_lock_irq(&motu->lock);
401 if (WARN_ON(motu->dev_lock_count <= 0))
404 if (--motu->dev_lock_count == 0)
405 motu_lock_changed(motu);
407 spin_unlock_irq(&motu->lock);