1 // SPDX-License-Identifier: GPL-2.0
2 // ff-protocol-former.c - a part of driver for RME Fireface series
3 //
4 // Copyright (c) 2019 Takashi Sakamoto
5 //
6 // Licensed under the terms of the GNU General Public License, version 2.
7 
8 #include <linux/delay.h>
9 
10 #include "ff.h"
11 
12 #define FORMER_REG_SYNC_STATUS		0x0000801c0000ull
13 /* For block write request. */
14 #define FORMER_REG_FETCH_PCM_FRAMES	0x0000801c0000ull
15 #define FORMER_REG_CLOCK_CONFIG		0x0000801c0004ull
16 
17 static int parse_clock_bits(u32 data, unsigned int *rate,
18 			    enum snd_ff_clock_src *src)
19 {
20 	static const struct {
21 		unsigned int rate;
22 		u32 mask;
23 	} *rate_entry, rate_entries[] = {
24 		{  32000, 0x00000002, },
25 		{  44100, 0x00000000, },
26 		{  48000, 0x00000006, },
27 		{  64000, 0x0000000a, },
28 		{  88200, 0x00000008, },
29 		{  96000, 0x0000000e, },
30 		{ 128000, 0x00000012, },
31 		{ 176400, 0x00000010, },
32 		{ 192000, 0x00000016, },
33 	};
34 	static const struct {
35 		enum snd_ff_clock_src src;
36 		u32 mask;
37 	} *clk_entry, clk_entries[] = {
38 		{ SND_FF_CLOCK_SRC_ADAT1,	0x00000000, },
39 		{ SND_FF_CLOCK_SRC_ADAT2,	0x00000400, },
40 		{ SND_FF_CLOCK_SRC_SPDIF,	0x00000c00, },
41 		{ SND_FF_CLOCK_SRC_WORD,	0x00001000, },
42 		{ SND_FF_CLOCK_SRC_LTC,		0x00001800, },
43 	};
44 	int i;
45 
46 	for (i = 0; i < ARRAY_SIZE(rate_entries); ++i) {
47 		rate_entry = rate_entries + i;
48 		if ((data & 0x0000001e) == rate_entry->mask) {
49 			*rate = rate_entry->rate;
50 			break;
51 		}
52 	}
53 	if (i == ARRAY_SIZE(rate_entries))
54 		return -EIO;
55 
56 	if (data & 0x00000001) {
57 		*src = SND_FF_CLOCK_SRC_INTERNAL;
58 	} else {
59 		for (i = 0; i < ARRAY_SIZE(clk_entries); ++i) {
60 			clk_entry = clk_entries + i;
61 			if ((data & 0x00001c00) == clk_entry->mask) {
62 				*src = clk_entry->src;
63 				break;
64 			}
65 		}
66 		if (i == ARRAY_SIZE(clk_entries))
67 			return -EIO;
68 	}
69 
70 	return 0;
71 }
72 
73 static int former_get_clock(struct snd_ff *ff, unsigned int *rate,
74 			    enum snd_ff_clock_src *src)
75 {
76 	__le32 reg;
77 	u32 data;
78 	int err;
79 
80 	err = snd_fw_transaction(ff->unit, TCODE_READ_QUADLET_REQUEST,
81 				 FORMER_REG_CLOCK_CONFIG, &reg, sizeof(reg), 0);
82 	if (err < 0)
83 		return err;
84 	data = le32_to_cpu(reg);
85 
86 	return parse_clock_bits(data, rate, src);
87 }
88 
89 static int former_switch_fetching_mode(struct snd_ff *ff, bool enable)
90 {
91 	unsigned int count;
92 	__le32 *reg;
93 	int i;
94 	int err;
95 
96 	count = 0;
97 	for (i = 0; i < SND_FF_STREAM_MODE_COUNT; ++i)
98 		count = max(count, ff->spec->pcm_playback_channels[i]);
99 
100 	reg = kcalloc(count, sizeof(__le32), GFP_KERNEL);
101 	if (!reg)
102 		return -ENOMEM;
103 
104 	if (!enable) {
105 		/*
106 		 * Each quadlet is corresponding to data channels in a data
107 		 * blocks in reverse order. Precisely, quadlets for available
108 		 * data channels should be enabled. Here, I take second best
109 		 * to fetch PCM frames from all of data channels regardless of
110 		 * stf.
111 		 */
112 		for (i = 0; i < count; ++i)
113 			reg[i] = cpu_to_le32(0x00000001);
114 	}
115 
116 	err = snd_fw_transaction(ff->unit, TCODE_WRITE_BLOCK_REQUEST,
117 				 FORMER_REG_FETCH_PCM_FRAMES, reg,
118 				 sizeof(__le32) * count, 0);
119 	kfree(reg);
120 	return err;
121 }
122 
123 static void dump_clock_config(struct snd_ff *ff, struct snd_info_buffer *buffer)
124 {
125 	__le32 reg;
126 	u32 data;
127 	unsigned int rate;
128 	enum snd_ff_clock_src src;
129 	const char *label;
130 	int err;
131 
132 	err = snd_fw_transaction(ff->unit, TCODE_READ_BLOCK_REQUEST,
133 				 FORMER_REG_CLOCK_CONFIG, &reg, sizeof(reg), 0);
134 	if (err < 0)
135 		return;
136 	data = le32_to_cpu(reg);
137 
138 	snd_iprintf(buffer, "Output S/PDIF format: %s (Emphasis: %s)\n",
139 		    (data & 0x00000020) ? "Professional" : "Consumer",
140 		    (data & 0x00000040) ? "on" : "off");
141 
142 	snd_iprintf(buffer, "Optical output interface format: %s\n",
143 		    (data & 0x00000100) ? "S/PDIF" : "ADAT");
144 
145 	snd_iprintf(buffer, "Word output single speed: %s\n",
146 		    (data & 0x00002000) ? "on" : "off");
147 
148 	snd_iprintf(buffer, "S/PDIF input interface: %s\n",
149 		    (data & 0x00000200) ? "Optical" : "Coaxial");
150 
151 	err = parse_clock_bits(data, &rate, &src);
152 	if (err < 0)
153 		return;
154 	label = snd_ff_proc_get_clk_label(src);
155 	if (!label)
156 		return;
157 
158 	snd_iprintf(buffer, "Clock configuration: %d %s\n", rate, label);
159 }
160 
161 static void dump_sync_status(struct snd_ff *ff, struct snd_info_buffer *buffer)
162 {
163 	static const struct {
164 		char *const label;
165 		u32 locked_mask;
166 		u32 synced_mask;
167 	} *clk_entry, clk_entries[] = {
168 		{ "WDClk",	0x40000000, 0x20000000, },
169 		{ "S/PDIF",	0x00080000, 0x00040000, },
170 		{ "ADAT1",	0x00000400, 0x00001000, },
171 		{ "ADAT2",	0x00000800, 0x00002000, },
172 	};
173 	static const struct {
174 		char *const label;
175 		u32 mask;
176 	} *referred_entry, referred_entries[] = {
177 		{ "ADAT1",	0x00000000, },
178 		{ "ADAT2",	0x00400000, },
179 		{ "S/PDIF",	0x00c00000, },
180 		{ "WDclk",	0x01000000, },
181 		{ "TCO",	0x01400000, },
182 	};
183 	static const struct {
184 		unsigned int rate;
185 		u32 mask;
186 	} *rate_entry, rate_entries[] = {
187 		{ 32000,	0x02000000, },
188 		{ 44100,	0x04000000, },
189 		{ 48000,	0x06000000, },
190 		{ 64000,	0x08000000, },
191 		{ 88200,	0x0a000000, },
192 		{ 96000,	0x0c000000, },
193 		{ 128000,	0x0e000000, },
194 		{ 176400,	0x10000000, },
195 		{ 192000,	0x12000000, },
196 	};
197 	__le32 reg[2];
198 	u32 data[2];
199 	int i;
200 	int err;
201 
202 	err = snd_fw_transaction(ff->unit, TCODE_READ_BLOCK_REQUEST,
203 				 FORMER_REG_SYNC_STATUS, reg, sizeof(reg), 0);
204 	if (err < 0)
205 		return;
206 	data[0] = le32_to_cpu(reg[0]);
207 	data[1] = le32_to_cpu(reg[1]);
208 
209 	snd_iprintf(buffer, "External source detection:\n");
210 
211 	for (i = 0; i < ARRAY_SIZE(clk_entries); ++i) {
212 		const char *state;
213 
214 		clk_entry = clk_entries + i;
215 		if (data[0] & clk_entry->locked_mask) {
216 			if (data[0] & clk_entry->synced_mask)
217 				state = "sync";
218 			else
219 				state = "lock";
220 		} else {
221 			state = "none";
222 		}
223 
224 		snd_iprintf(buffer, "%s: %s\n", clk_entry->label, state);
225 	}
226 
227 	snd_iprintf(buffer, "Referred clock:\n");
228 
229 	if (data[1] & 0x00000001) {
230 		snd_iprintf(buffer, "Internal\n");
231 	} else {
232 		unsigned int rate;
233 		const char *label;
234 
235 		for (i = 0; i < ARRAY_SIZE(referred_entries); ++i) {
236 			referred_entry = referred_entries + i;
237 			if ((data[0] & 0x1e0000) == referred_entry->mask) {
238 				label = referred_entry->label;
239 				break;
240 			}
241 		}
242 		if (i == ARRAY_SIZE(referred_entries))
243 			label = "none";
244 
245 		for (i = 0; i < ARRAY_SIZE(rate_entries); ++i) {
246 			rate_entry = rate_entries + i;
247 			if ((data[0] & 0x1e000000) == rate_entry->mask) {
248 				rate = rate_entry->rate;
249 				break;
250 			}
251 		}
252 		if (i == ARRAY_SIZE(rate_entries))
253 			rate = 0;
254 
255 		snd_iprintf(buffer, "%s %d\n", label, rate);
256 	}
257 }
258 
259 static void former_dump_status(struct snd_ff *ff,
260 			       struct snd_info_buffer *buffer)
261 {
262 	dump_clock_config(ff, buffer);
263 	dump_sync_status(ff, buffer);
264 }
265 
266 static int former_fill_midi_msg(struct snd_ff *ff,
267 				struct snd_rawmidi_substream *substream,
268 				unsigned int port)
269 {
270 	u8 *buf = (u8 *)ff->msg_buf[port];
271 	int len;
272 	int i;
273 
274 	len = snd_rawmidi_transmit_peek(substream, buf,
275 					SND_FF_MAXIMIM_MIDI_QUADS);
276 	if (len <= 0)
277 		return len;
278 
279 	// One quadlet includes one byte.
280 	for (i = len - 1; i >= 0; --i)
281 		ff->msg_buf[port][i] = cpu_to_le32(buf[i]);
282 	ff->rx_bytes[port] = len;
283 
284 	return len;
285 }
286 
287 #define FF800_STF		0x0000fc88f000
288 #define FF800_RX_PACKET_FORMAT	0x0000fc88f004
289 #define FF800_ALLOC_TX_STREAM	0x0000fc88f008
290 #define FF800_ISOC_COMM_START	0x0000fc88f00c
291 #define   FF800_TX_S800_FLAG	0x00000800
292 #define FF800_ISOC_COMM_STOP	0x0000fc88f010
293 
294 #define FF800_TX_PACKET_ISOC_CH	0x0000801c0008
295 
296 static int allocate_tx_resources(struct snd_ff *ff)
297 {
298 	__le32 reg;
299 	unsigned int count;
300 	unsigned int tx_isoc_channel;
301 	int err;
302 
303 	reg = cpu_to_le32(ff->tx_stream.data_block_quadlets);
304 	err = snd_fw_transaction(ff->unit, TCODE_WRITE_QUADLET_REQUEST,
305 				 FF800_ALLOC_TX_STREAM, &reg, sizeof(reg), 0);
306 	if (err < 0)
307 		return err;
308 
309 	// Wait till the format of tx packet is available.
310 	count = 0;
311 	while (count++ < 10) {
312 		u32 data;
313 		err = snd_fw_transaction(ff->unit, TCODE_READ_QUADLET_REQUEST,
314 				FF800_TX_PACKET_ISOC_CH, &reg, sizeof(reg), 0);
315 		if (err < 0)
316 			return err;
317 
318 		data = le32_to_cpu(reg);
319 		if (data != 0xffffffff) {
320 			tx_isoc_channel = data;
321 			break;
322 		}
323 
324 		msleep(50);
325 	}
326 	if (count >= 10)
327 		return -ETIMEDOUT;
328 
329 	// NOTE: this is a makeshift to start OHCI 1394 IR context in the
330 	// channel. On the other hand, 'struct fw_iso_resources.allocated' is
331 	// not true and it's not deallocated at stop.
332 	ff->tx_resources.channel = tx_isoc_channel;
333 
334 	return 0;
335 }
336 
337 static int ff800_allocate_resources(struct snd_ff *ff, unsigned int rate)
338 {
339 	u32 data;
340 	__le32 reg;
341 	int err;
342 
343 	reg = cpu_to_le32(rate);
344 	err = snd_fw_transaction(ff->unit, TCODE_WRITE_QUADLET_REQUEST,
345 				 FF800_STF, &reg, sizeof(reg), 0);
346 	if (err < 0)
347 		return err;
348 
349 	// If starting isochronous communication immediately, change of STF has
350 	// no effect. In this case, the communication runs based on former STF.
351 	// Let's sleep for a bit.
352 	msleep(100);
353 
354 	// Controllers should allocate isochronous resources for rx stream.
355 	err = fw_iso_resources_allocate(&ff->rx_resources,
356 				amdtp_stream_get_max_payload(&ff->rx_stream),
357 				fw_parent_device(ff->unit)->max_speed);
358 	if (err < 0)
359 		return err;
360 
361 	// Set isochronous channel and the number of quadlets of rx packets.
362 	// This should be done before the allocation of tx resources to avoid
363 	// periodical noise.
364 	data = ff->rx_stream.data_block_quadlets << 3;
365 	data = (data << 8) | ff->rx_resources.channel;
366 	reg = cpu_to_le32(data);
367 	err = snd_fw_transaction(ff->unit, TCODE_WRITE_QUADLET_REQUEST,
368 				 FF800_RX_PACKET_FORMAT, &reg, sizeof(reg), 0);
369 	if (err < 0)
370 		return err;
371 
372 	return allocate_tx_resources(ff);
373 }
374 
375 static int ff800_begin_session(struct snd_ff *ff, unsigned int rate)
376 {
377 	unsigned int generation = ff->rx_resources.generation;
378 	__le32 reg;
379 
380 	if (generation != fw_parent_device(ff->unit)->card->generation) {
381 		int err = fw_iso_resources_update(&ff->rx_resources);
382 		if (err < 0)
383 			return err;
384 	}
385 
386 	reg = cpu_to_le32(0x80000000);
387 	reg |= cpu_to_le32(ff->tx_stream.data_block_quadlets);
388 	if (fw_parent_device(ff->unit)->max_speed == SCODE_800)
389 		reg |= cpu_to_le32(FF800_TX_S800_FLAG);
390 	return snd_fw_transaction(ff->unit, TCODE_WRITE_QUADLET_REQUEST,
391 				 FF800_ISOC_COMM_START, &reg, sizeof(reg), 0);
392 }
393 
394 static void ff800_finish_session(struct snd_ff *ff)
395 {
396 	__le32 reg;
397 
398 	reg = cpu_to_le32(0x80000000);
399 	snd_fw_transaction(ff->unit, TCODE_WRITE_QUADLET_REQUEST,
400 			   FF800_ISOC_COMM_STOP, &reg, sizeof(reg), 0);
401 }
402 
403 // Fireface 800 doesn't allow drivers to register lower 4 bytes of destination
404 // address.
405 // A write transaction to clear registered higher 4 bytes of destination address
406 // has an effect to suppress asynchronous transaction from device.
407 static void ff800_handle_midi_msg(struct snd_ff *ff, unsigned int offset,
408 				  __le32 *buf, size_t length)
409 {
410 	int i;
411 
412 	for (i = 0; i < length / 4; i++) {
413 		u8 byte = le32_to_cpu(buf[i]) & 0xff;
414 		struct snd_rawmidi_substream *substream;
415 
416 		substream = READ_ONCE(ff->tx_midi_substreams[0]);
417 		if (substream)
418 			snd_rawmidi_receive(substream, &byte, 1);
419 	}
420 }
421 
422 const struct snd_ff_protocol snd_ff_protocol_ff800 = {
423 	.handle_midi_msg	= ff800_handle_midi_msg,
424 	.fill_midi_msg		= former_fill_midi_msg,
425 	.get_clock		= former_get_clock,
426 	.switch_fetching_mode	= former_switch_fetching_mode,
427 	.allocate_resources	= ff800_allocate_resources,
428 	.begin_session		= ff800_begin_session,
429 	.finish_session		= ff800_finish_session,
430 	.dump_status		= former_dump_status,
431 };
432 
433 #define FF400_STF		0x000080100500ull
434 #define FF400_RX_PACKET_FORMAT	0x000080100504ull
435 #define FF400_ISOC_COMM_START	0x000080100508ull
436 #define FF400_TX_PACKET_FORMAT	0x00008010050cull
437 #define FF400_ISOC_COMM_STOP	0x000080100510ull
438 
439 // Fireface 400 manages isochronous channel number in 3 bit field. Therefore,
440 // we can allocate between 0 and 7 channel.
441 static int ff400_allocate_resources(struct snd_ff *ff, unsigned int rate)
442 {
443 	__le32 reg;
444 	enum snd_ff_stream_mode mode;
445 	int i;
446 	int err;
447 
448 	// Check whether the given value is supported or not.
449 	for (i = 0; i < CIP_SFC_COUNT; i++) {
450 		if (amdtp_rate_table[i] == rate)
451 			break;
452 	}
453 	if (i >= CIP_SFC_COUNT)
454 		return -EINVAL;
455 
456 	// Set the number of data blocks transferred in a second.
457 	reg = cpu_to_le32(rate);
458 	err = snd_fw_transaction(ff->unit, TCODE_WRITE_QUADLET_REQUEST,
459 				 FF400_STF, &reg, sizeof(reg), 0);
460 	if (err < 0)
461 		return err;
462 
463 	msleep(100);
464 
465 	err = snd_ff_stream_get_multiplier_mode(i, &mode);
466 	if (err < 0)
467 		return err;
468 
469 	// Keep resources for in-stream.
470 	ff->tx_resources.channels_mask = 0x00000000000000ffuLL;
471 	err = fw_iso_resources_allocate(&ff->tx_resources,
472 			amdtp_stream_get_max_payload(&ff->tx_stream),
473 			fw_parent_device(ff->unit)->max_speed);
474 	if (err < 0)
475 		return err;
476 
477 	// Keep resources for out-stream.
478 	ff->rx_resources.channels_mask = 0x00000000000000ffuLL;
479 	err = fw_iso_resources_allocate(&ff->rx_resources,
480 			amdtp_stream_get_max_payload(&ff->rx_stream),
481 			fw_parent_device(ff->unit)->max_speed);
482 	if (err < 0)
483 		fw_iso_resources_free(&ff->tx_resources);
484 
485 	return err;
486 }
487 
488 static int ff400_begin_session(struct snd_ff *ff, unsigned int rate)
489 {
490 	unsigned int generation = ff->rx_resources.generation;
491 	__le32 reg;
492 	int err;
493 
494 	if (generation != fw_parent_device(ff->unit)->card->generation) {
495 		err = fw_iso_resources_update(&ff->tx_resources);
496 		if (err < 0)
497 			return err;
498 
499 		err = fw_iso_resources_update(&ff->rx_resources);
500 		if (err < 0)
501 			return err;
502 	}
503 
504 	// Set isochronous channel and the number of quadlets of received
505 	// packets.
506 	reg = cpu_to_le32(((ff->rx_stream.data_block_quadlets << 3) << 8) |
507 			  ff->rx_resources.channel);
508 	err = snd_fw_transaction(ff->unit, TCODE_WRITE_QUADLET_REQUEST,
509 				 FF400_RX_PACKET_FORMAT, &reg, sizeof(reg), 0);
510 	if (err < 0)
511 		return err;
512 
513 	// Set isochronous channel and the number of quadlets of transmitted
514 	// packet.
515 	// TODO: investigate the purpose of this 0x80.
516 	reg = cpu_to_le32((0x80 << 24) |
517 			  (ff->tx_resources.channel << 5) |
518 			  (ff->tx_stream.data_block_quadlets));
519 	err = snd_fw_transaction(ff->unit, TCODE_WRITE_QUADLET_REQUEST,
520 				 FF400_TX_PACKET_FORMAT, &reg, sizeof(reg), 0);
521 	if (err < 0)
522 		return err;
523 
524 	// Allow to transmit packets.
525 	reg = cpu_to_le32(0x00000001);
526 	return snd_fw_transaction(ff->unit, TCODE_WRITE_QUADLET_REQUEST,
527 				 FF400_ISOC_COMM_START, &reg, sizeof(reg), 0);
528 }
529 
530 static void ff400_finish_session(struct snd_ff *ff)
531 {
532 	__le32 reg;
533 
534 	reg = cpu_to_le32(0x80000000);
535 	snd_fw_transaction(ff->unit, TCODE_WRITE_QUADLET_REQUEST,
536 			   FF400_ISOC_COMM_STOP, &reg, sizeof(reg), 0);
537 }
538 
539 // For Fireface 400, lower 4 bytes of destination address is configured by bit
540 // flag in quadlet register (little endian) at 0x'0000'801'0051c. Drivers can
541 // select one of 4 options:
542 //
543 // bit flags: offset of destination address
544 //  - 0x04000000: 0x'....'....'0000'0000
545 //  - 0x08000000: 0x'....'....'0000'0080
546 //  - 0x10000000: 0x'....'....'0000'0100
547 //  - 0x20000000: 0x'....'....'0000'0180
548 //
549 // Drivers can suppress the device to transfer asynchronous transactions by
550 // using below 2 bits.
551 //  - 0x01000000: suppress transmission
552 //  - 0x02000000: suppress transmission
553 //
554 // Actually, the register is write-only and includes the other options such as
555 // input attenuation. This driver allocates destination address with '0000'0000
556 // in its lower offset and expects userspace application to configure the
557 // register for it.
558 static void ff400_handle_midi_msg(struct snd_ff *ff, unsigned int offset,
559 				  __le32 *buf, size_t length)
560 {
561 	int i;
562 
563 	for (i = 0; i < length / 4; i++) {
564 		u32 quad = le32_to_cpu(buf[i]);
565 		u8 byte;
566 		unsigned int index;
567 		struct snd_rawmidi_substream *substream;
568 
569 		/* Message in first port. */
570 		/*
571 		 * This value may represent the index of this unit when the same
572 		 * units are on the same IEEE 1394 bus. This driver doesn't use
573 		 * it.
574 		 */
575 		index = (quad >> 8) & 0xff;
576 		if (index > 0) {
577 			substream = READ_ONCE(ff->tx_midi_substreams[0]);
578 			if (substream != NULL) {
579 				byte = quad & 0xff;
580 				snd_rawmidi_receive(substream, &byte, 1);
581 			}
582 		}
583 
584 		/* Message in second port. */
585 		index = (quad >> 24) & 0xff;
586 		if (index > 0) {
587 			substream = READ_ONCE(ff->tx_midi_substreams[1]);
588 			if (substream != NULL) {
589 				byte = (quad >> 16) & 0xff;
590 				snd_rawmidi_receive(substream, &byte, 1);
591 			}
592 		}
593 	}
594 }
595 
596 const struct snd_ff_protocol snd_ff_protocol_ff400 = {
597 	.handle_midi_msg	= ff400_handle_midi_msg,
598 	.fill_midi_msg		= former_fill_midi_msg,
599 	.get_clock		= former_get_clock,
600 	.switch_fetching_mode	= former_switch_fetching_mode,
601 	.allocate_resources	= ff400_allocate_resources,
602 	.begin_session		= ff400_begin_session,
603 	.finish_session		= ff400_finish_session,
604 	.dump_status		= former_dump_status,
605 };
606