1eb7b3a05STakashi Sakamoto /*
2eb7b3a05STakashi Sakamoto  * bebob_stream.c - a part of driver for BeBoB based devices
3eb7b3a05STakashi Sakamoto  *
4eb7b3a05STakashi Sakamoto  * Copyright (c) 2013-2014 Takashi Sakamoto
5eb7b3a05STakashi Sakamoto  *
6eb7b3a05STakashi Sakamoto  * Licensed under the terms of the GNU General Public License, version 2.
7eb7b3a05STakashi Sakamoto  */
8eb7b3a05STakashi Sakamoto 
9eb7b3a05STakashi Sakamoto #include "./bebob.h"
10eb7b3a05STakashi Sakamoto 
11eb7b3a05STakashi Sakamoto #define CALLBACK_TIMEOUT	1000
12eb7b3a05STakashi Sakamoto 
13eb7b3a05STakashi Sakamoto /*
14eb7b3a05STakashi Sakamoto  * NOTE;
15eb7b3a05STakashi Sakamoto  * For BeBoB streams, Both of input and output CMP connection are important.
16eb7b3a05STakashi Sakamoto  *
17eb7b3a05STakashi Sakamoto  * For most devices, each CMP connection starts to transmit/receive a
18eb7b3a05STakashi Sakamoto  * corresponding stream. But for a few devices, both of CMP connection needs
19eb7b3a05STakashi Sakamoto  * to start transmitting stream. An example is 'M-Audio Firewire 410'.
20eb7b3a05STakashi Sakamoto  */
21eb7b3a05STakashi Sakamoto 
22eb7b3a05STakashi Sakamoto /* 128 is an arbitrary length but it seems to be enough */
23eb7b3a05STakashi Sakamoto #define FORMAT_MAXIMUM_LENGTH 128
24eb7b3a05STakashi Sakamoto 
25eb7b3a05STakashi Sakamoto const unsigned int snd_bebob_rate_table[SND_BEBOB_STRM_FMT_ENTRIES] = {
26eb7b3a05STakashi Sakamoto 	[0] = 32000,
27eb7b3a05STakashi Sakamoto 	[1] = 44100,
28eb7b3a05STakashi Sakamoto 	[2] = 48000,
29eb7b3a05STakashi Sakamoto 	[3] = 88200,
30eb7b3a05STakashi Sakamoto 	[4] = 96000,
31eb7b3a05STakashi Sakamoto 	[5] = 176400,
32eb7b3a05STakashi Sakamoto 	[6] = 192000,
33eb7b3a05STakashi Sakamoto };
34eb7b3a05STakashi Sakamoto 
35eb7b3a05STakashi Sakamoto /*
36eb7b3a05STakashi Sakamoto  * See: Table 51: Extended Stream Format Info ‘Sampling Frequency’
37eb7b3a05STakashi Sakamoto  * in Additional AVC commands (Nov 2003, BridgeCo)
38eb7b3a05STakashi Sakamoto  */
39eb7b3a05STakashi Sakamoto static const unsigned int bridgeco_freq_table[] = {
40eb7b3a05STakashi Sakamoto 	[0] = 0x02,
41eb7b3a05STakashi Sakamoto 	[1] = 0x03,
42eb7b3a05STakashi Sakamoto 	[2] = 0x04,
43eb7b3a05STakashi Sakamoto 	[3] = 0x0a,
44eb7b3a05STakashi Sakamoto 	[4] = 0x05,
45eb7b3a05STakashi Sakamoto 	[5] = 0x06,
46eb7b3a05STakashi Sakamoto 	[6] = 0x07,
47eb7b3a05STakashi Sakamoto };
48eb7b3a05STakashi Sakamoto 
49eb7b3a05STakashi Sakamoto static unsigned int
50eb7b3a05STakashi Sakamoto get_formation_index(unsigned int rate)
51eb7b3a05STakashi Sakamoto {
52eb7b3a05STakashi Sakamoto 	unsigned int i;
53eb7b3a05STakashi Sakamoto 
54eb7b3a05STakashi Sakamoto 	for (i = 0; i < ARRAY_SIZE(snd_bebob_rate_table); i++) {
55eb7b3a05STakashi Sakamoto 		if (snd_bebob_rate_table[i] == rate)
56eb7b3a05STakashi Sakamoto 			return i;
57eb7b3a05STakashi Sakamoto 	}
58eb7b3a05STakashi Sakamoto 	return -EINVAL;
59eb7b3a05STakashi Sakamoto }
60eb7b3a05STakashi Sakamoto 
61eb7b3a05STakashi Sakamoto int
62eb7b3a05STakashi Sakamoto snd_bebob_stream_get_rate(struct snd_bebob *bebob, unsigned int *curr_rate)
63eb7b3a05STakashi Sakamoto {
64eb7b3a05STakashi Sakamoto 	unsigned int tx_rate, rx_rate, trials;
65eb7b3a05STakashi Sakamoto 	int err;
66eb7b3a05STakashi Sakamoto 
67eb7b3a05STakashi Sakamoto 	trials = 0;
68eb7b3a05STakashi Sakamoto 	do {
69eb7b3a05STakashi Sakamoto 		err = avc_general_get_sig_fmt(bebob->unit, &tx_rate,
70eb7b3a05STakashi Sakamoto 					      AVC_GENERAL_PLUG_DIR_OUT, 0);
71eb7b3a05STakashi Sakamoto 	} while (err == -EAGAIN && ++trials < 3);
72eb7b3a05STakashi Sakamoto 	if (err < 0)
73eb7b3a05STakashi Sakamoto 		goto end;
74eb7b3a05STakashi Sakamoto 
75eb7b3a05STakashi Sakamoto 	trials = 0;
76eb7b3a05STakashi Sakamoto 	do {
77eb7b3a05STakashi Sakamoto 		err = avc_general_get_sig_fmt(bebob->unit, &rx_rate,
78eb7b3a05STakashi Sakamoto 					      AVC_GENERAL_PLUG_DIR_IN, 0);
79eb7b3a05STakashi Sakamoto 	} while (err == -EAGAIN && ++trials < 3);
80eb7b3a05STakashi Sakamoto 	if (err < 0)
81eb7b3a05STakashi Sakamoto 		goto end;
82eb7b3a05STakashi Sakamoto 
83eb7b3a05STakashi Sakamoto 	*curr_rate = rx_rate;
84eb7b3a05STakashi Sakamoto 	if (rx_rate == tx_rate)
85eb7b3a05STakashi Sakamoto 		goto end;
86eb7b3a05STakashi Sakamoto 
87eb7b3a05STakashi Sakamoto 	/* synchronize receive stream rate to transmit stream rate */
88eb7b3a05STakashi Sakamoto 	err = avc_general_set_sig_fmt(bebob->unit, rx_rate,
89eb7b3a05STakashi Sakamoto 				      AVC_GENERAL_PLUG_DIR_IN, 0);
90eb7b3a05STakashi Sakamoto end:
91eb7b3a05STakashi Sakamoto 	return err;
92eb7b3a05STakashi Sakamoto }
93eb7b3a05STakashi Sakamoto 
94eb7b3a05STakashi Sakamoto int
95eb7b3a05STakashi Sakamoto snd_bebob_stream_set_rate(struct snd_bebob *bebob, unsigned int rate)
96eb7b3a05STakashi Sakamoto {
97eb7b3a05STakashi Sakamoto 	int err;
98eb7b3a05STakashi Sakamoto 
99eb7b3a05STakashi Sakamoto 	err = avc_general_set_sig_fmt(bebob->unit, rate,
100eb7b3a05STakashi Sakamoto 				      AVC_GENERAL_PLUG_DIR_OUT, 0);
101eb7b3a05STakashi Sakamoto 	if (err < 0)
102eb7b3a05STakashi Sakamoto 		goto end;
103eb7b3a05STakashi Sakamoto 
104eb7b3a05STakashi Sakamoto 	err = avc_general_set_sig_fmt(bebob->unit, rate,
105eb7b3a05STakashi Sakamoto 				      AVC_GENERAL_PLUG_DIR_IN, 0);
106eb7b3a05STakashi Sakamoto 	if (err < 0)
107eb7b3a05STakashi Sakamoto 		goto end;
108eb7b3a05STakashi Sakamoto 
109eb7b3a05STakashi Sakamoto 	/*
110eb7b3a05STakashi Sakamoto 	 * Some devices need a bit time for transition.
111eb7b3a05STakashi Sakamoto 	 * 300msec is got by some experiments.
112eb7b3a05STakashi Sakamoto 	 */
113eb7b3a05STakashi Sakamoto 	msleep(300);
114eb7b3a05STakashi Sakamoto end:
115eb7b3a05STakashi Sakamoto 	return err;
116eb7b3a05STakashi Sakamoto }
117eb7b3a05STakashi Sakamoto 
118eb7b3a05STakashi Sakamoto int
119eb7b3a05STakashi Sakamoto snd_bebob_stream_check_internal_clock(struct snd_bebob *bebob, bool *internal)
120eb7b3a05STakashi Sakamoto {
121eb7b3a05STakashi Sakamoto 	u8 addr[AVC_BRIDGECO_ADDR_BYTES], input[7];
122eb7b3a05STakashi Sakamoto 	int err = 0;
123eb7b3a05STakashi Sakamoto 
124eb7b3a05STakashi Sakamoto 	*internal = false;
125eb7b3a05STakashi Sakamoto 
126eb7b3a05STakashi Sakamoto 	/*
127eb7b3a05STakashi Sakamoto 	 * 1.The device don't support to switch source of clock then assumed
128eb7b3a05STakashi Sakamoto 	 *   to use internal clock always
129eb7b3a05STakashi Sakamoto 	 */
130eb7b3a05STakashi Sakamoto 	if (bebob->sync_input_plug < 0) {
131eb7b3a05STakashi Sakamoto 		*internal = true;
132eb7b3a05STakashi Sakamoto 		goto end;
133eb7b3a05STakashi Sakamoto 	}
134eb7b3a05STakashi Sakamoto 
135eb7b3a05STakashi Sakamoto 	/*
136eb7b3a05STakashi Sakamoto 	 * 2.The device supports to switch source of clock by an usual way.
137eb7b3a05STakashi Sakamoto 	 *   Let's check input for 'Music Sub Unit Sync Input' plug.
138eb7b3a05STakashi Sakamoto 	 */
139eb7b3a05STakashi Sakamoto 	avc_bridgeco_fill_msu_addr(addr, AVC_BRIDGECO_PLUG_DIR_IN,
140eb7b3a05STakashi Sakamoto 				   bebob->sync_input_plug);
141eb7b3a05STakashi Sakamoto 	err = avc_bridgeco_get_plug_input(bebob->unit, addr, input);
142eb7b3a05STakashi Sakamoto 	if (err < 0) {
143eb7b3a05STakashi Sakamoto 		dev_err(&bebob->unit->device,
144eb7b3a05STakashi Sakamoto 			"fail to get an input for MSU in plug %d: %d\n",
145eb7b3a05STakashi Sakamoto 			bebob->sync_input_plug, err);
146eb7b3a05STakashi Sakamoto 		goto end;
147eb7b3a05STakashi Sakamoto 	}
148eb7b3a05STakashi Sakamoto 
149eb7b3a05STakashi Sakamoto 	/*
150eb7b3a05STakashi Sakamoto 	 * If there are no input plugs, all of fields are 0xff.
151eb7b3a05STakashi Sakamoto 	 * Here check the first field. This field is used for direction.
152eb7b3a05STakashi Sakamoto 	 */
153eb7b3a05STakashi Sakamoto 	if (input[0] == 0xff) {
154eb7b3a05STakashi Sakamoto 		*internal = true;
155eb7b3a05STakashi Sakamoto 		goto end;
156eb7b3a05STakashi Sakamoto 	}
157eb7b3a05STakashi Sakamoto 
158eb7b3a05STakashi Sakamoto 	/*
159eb7b3a05STakashi Sakamoto 	 * If source of clock is internal CSR, Music Sub Unit Sync Input is
160eb7b3a05STakashi Sakamoto 	 * a destination of Music Sub Unit Sync Output.
161eb7b3a05STakashi Sakamoto 	 */
162eb7b3a05STakashi Sakamoto 	*internal = ((input[0] == AVC_BRIDGECO_PLUG_DIR_OUT) &&
163eb7b3a05STakashi Sakamoto 		     (input[1] == AVC_BRIDGECO_PLUG_MODE_SUBUNIT) &&
164eb7b3a05STakashi Sakamoto 		     (input[2] == 0x0c) &&
165eb7b3a05STakashi Sakamoto 		     (input[3] == 0x00));
166eb7b3a05STakashi Sakamoto end:
167eb7b3a05STakashi Sakamoto 	return err;
168eb7b3a05STakashi Sakamoto }
169eb7b3a05STakashi Sakamoto 
170eb7b3a05STakashi Sakamoto static unsigned int
171eb7b3a05STakashi Sakamoto map_data_channels(struct snd_bebob *bebob, struct amdtp_stream *s)
172eb7b3a05STakashi Sakamoto {
173eb7b3a05STakashi Sakamoto 	unsigned int sec, sections, ch, channels;
174eb7b3a05STakashi Sakamoto 	unsigned int pcm, midi, location;
175eb7b3a05STakashi Sakamoto 	unsigned int stm_pos, sec_loc, pos;
176eb7b3a05STakashi Sakamoto 	u8 *buf, addr[AVC_BRIDGECO_ADDR_BYTES], type;
177eb7b3a05STakashi Sakamoto 	enum avc_bridgeco_plug_dir dir;
178eb7b3a05STakashi Sakamoto 	int err;
179eb7b3a05STakashi Sakamoto 
180eb7b3a05STakashi Sakamoto 	/*
181eb7b3a05STakashi Sakamoto 	 * The length of return value of this command cannot be expected. Here
182eb7b3a05STakashi Sakamoto 	 * use the maximum length of FCP.
183eb7b3a05STakashi Sakamoto 	 */
184eb7b3a05STakashi Sakamoto 	buf = kzalloc(256, GFP_KERNEL);
185eb7b3a05STakashi Sakamoto 	if (buf == NULL)
186eb7b3a05STakashi Sakamoto 		return -ENOMEM;
187eb7b3a05STakashi Sakamoto 
188eb7b3a05STakashi Sakamoto 	if (s == &bebob->tx_stream)
189eb7b3a05STakashi Sakamoto 		dir = AVC_BRIDGECO_PLUG_DIR_OUT;
190eb7b3a05STakashi Sakamoto 	else
191eb7b3a05STakashi Sakamoto 		dir = AVC_BRIDGECO_PLUG_DIR_IN;
192eb7b3a05STakashi Sakamoto 
193eb7b3a05STakashi Sakamoto 	avc_bridgeco_fill_unit_addr(addr, dir, AVC_BRIDGECO_PLUG_UNIT_ISOC, 0);
194eb7b3a05STakashi Sakamoto 	err = avc_bridgeco_get_plug_ch_pos(bebob->unit, addr, buf, 256);
195eb7b3a05STakashi Sakamoto 	if (err < 0) {
196eb7b3a05STakashi Sakamoto 		dev_err(&bebob->unit->device,
197eb7b3a05STakashi Sakamoto 			"fail to get channel position for isoc %s plug 0: %d\n",
198eb7b3a05STakashi Sakamoto 			(dir == AVC_BRIDGECO_PLUG_DIR_IN) ? "in" : "out",
199eb7b3a05STakashi Sakamoto 			err);
200eb7b3a05STakashi Sakamoto 		goto end;
201eb7b3a05STakashi Sakamoto 	}
202eb7b3a05STakashi Sakamoto 	pos = 0;
203eb7b3a05STakashi Sakamoto 
204eb7b3a05STakashi Sakamoto 	/* positions in I/O buffer */
205eb7b3a05STakashi Sakamoto 	pcm = 0;
206eb7b3a05STakashi Sakamoto 	midi = 0;
207eb7b3a05STakashi Sakamoto 
208eb7b3a05STakashi Sakamoto 	/* the number of sections in AMDTP packet */
209eb7b3a05STakashi Sakamoto 	sections = buf[pos++];
210eb7b3a05STakashi Sakamoto 
211eb7b3a05STakashi Sakamoto 	for (sec = 0; sec < sections; sec++) {
212eb7b3a05STakashi Sakamoto 		/* type of this section */
213eb7b3a05STakashi Sakamoto 		avc_bridgeco_fill_unit_addr(addr, dir,
214eb7b3a05STakashi Sakamoto 					    AVC_BRIDGECO_PLUG_UNIT_ISOC, 0);
215eb7b3a05STakashi Sakamoto 		err = avc_bridgeco_get_plug_section_type(bebob->unit, addr,
216eb7b3a05STakashi Sakamoto 							 sec, &type);
217eb7b3a05STakashi Sakamoto 		if (err < 0) {
218eb7b3a05STakashi Sakamoto 			dev_err(&bebob->unit->device,
219eb7b3a05STakashi Sakamoto 			"fail to get section type for isoc %s plug 0: %d\n",
220eb7b3a05STakashi Sakamoto 				(dir == AVC_BRIDGECO_PLUG_DIR_IN) ? "in" :
221eb7b3a05STakashi Sakamoto 								    "out",
222eb7b3a05STakashi Sakamoto 				err);
223eb7b3a05STakashi Sakamoto 			goto end;
224eb7b3a05STakashi Sakamoto 		}
225eb7b3a05STakashi Sakamoto 		/* NoType */
226eb7b3a05STakashi Sakamoto 		if (type == 0xff) {
227eb7b3a05STakashi Sakamoto 			err = -ENOSYS;
228eb7b3a05STakashi Sakamoto 			goto end;
229eb7b3a05STakashi Sakamoto 		}
230eb7b3a05STakashi Sakamoto 
231eb7b3a05STakashi Sakamoto 		/* the number of channels in this section */
232eb7b3a05STakashi Sakamoto 		channels = buf[pos++];
233eb7b3a05STakashi Sakamoto 
234eb7b3a05STakashi Sakamoto 		for (ch = 0; ch < channels; ch++) {
235eb7b3a05STakashi Sakamoto 			/* position of this channel in AMDTP packet */
236eb7b3a05STakashi Sakamoto 			stm_pos = buf[pos++] - 1;
237eb7b3a05STakashi Sakamoto 			/* location of this channel in this section */
238eb7b3a05STakashi Sakamoto 			sec_loc = buf[pos++] - 1;
239eb7b3a05STakashi Sakamoto 
240eb7b3a05STakashi Sakamoto 			switch (type) {
241eb7b3a05STakashi Sakamoto 			/* for MIDI conformant data channel */
242eb7b3a05STakashi Sakamoto 			case 0x0a:
243eb7b3a05STakashi Sakamoto 				/* AMDTP_MAX_CHANNELS_FOR_MIDI is 1. */
244eb7b3a05STakashi Sakamoto 				if ((midi > 0) && (stm_pos != midi)) {
245eb7b3a05STakashi Sakamoto 					err = -ENOSYS;
246eb7b3a05STakashi Sakamoto 					goto end;
247eb7b3a05STakashi Sakamoto 				}
248eb7b3a05STakashi Sakamoto 				s->midi_position = stm_pos;
249eb7b3a05STakashi Sakamoto 				midi = stm_pos;
250eb7b3a05STakashi Sakamoto 				break;
251eb7b3a05STakashi Sakamoto 			/* for PCM data channel */
252eb7b3a05STakashi Sakamoto 			case 0x01:	/* Headphone */
253eb7b3a05STakashi Sakamoto 			case 0x02:	/* Microphone */
254eb7b3a05STakashi Sakamoto 			case 0x03:	/* Line */
255eb7b3a05STakashi Sakamoto 			case 0x04:	/* SPDIF */
256eb7b3a05STakashi Sakamoto 			case 0x05:	/* ADAT */
257eb7b3a05STakashi Sakamoto 			case 0x06:	/* TDIF */
258eb7b3a05STakashi Sakamoto 			case 0x07:	/* MADI */
259eb7b3a05STakashi Sakamoto 			/* for undefined/changeable signal  */
260eb7b3a05STakashi Sakamoto 			case 0x08:	/* Analog */
261eb7b3a05STakashi Sakamoto 			case 0x09:	/* Digital */
262eb7b3a05STakashi Sakamoto 			default:
263eb7b3a05STakashi Sakamoto 				location = pcm + sec_loc;
264eb7b3a05STakashi Sakamoto 				if (location >= AMDTP_MAX_CHANNELS_FOR_PCM) {
265eb7b3a05STakashi Sakamoto 					err = -ENOSYS;
266eb7b3a05STakashi Sakamoto 					goto end;
267eb7b3a05STakashi Sakamoto 				}
268eb7b3a05STakashi Sakamoto 				s->pcm_positions[location] = stm_pos;
269eb7b3a05STakashi Sakamoto 				break;
270eb7b3a05STakashi Sakamoto 			}
271eb7b3a05STakashi Sakamoto 		}
272eb7b3a05STakashi Sakamoto 
273eb7b3a05STakashi Sakamoto 		if (type != 0x0a)
274eb7b3a05STakashi Sakamoto 			pcm += channels;
275eb7b3a05STakashi Sakamoto 		else
276eb7b3a05STakashi Sakamoto 			midi += channels;
277eb7b3a05STakashi Sakamoto 	}
278eb7b3a05STakashi Sakamoto end:
279eb7b3a05STakashi Sakamoto 	kfree(buf);
280eb7b3a05STakashi Sakamoto 	return err;
281eb7b3a05STakashi Sakamoto }
282eb7b3a05STakashi Sakamoto 
283eb7b3a05STakashi Sakamoto static int
284eb7b3a05STakashi Sakamoto init_both_connections(struct snd_bebob *bebob)
285eb7b3a05STakashi Sakamoto {
286eb7b3a05STakashi Sakamoto 	int err;
287eb7b3a05STakashi Sakamoto 
288eb7b3a05STakashi Sakamoto 	err = cmp_connection_init(&bebob->in_conn,
289eb7b3a05STakashi Sakamoto 				  bebob->unit, CMP_INPUT, 0);
290eb7b3a05STakashi Sakamoto 	if (err < 0)
291eb7b3a05STakashi Sakamoto 		goto end;
292eb7b3a05STakashi Sakamoto 
293eb7b3a05STakashi Sakamoto 	err = cmp_connection_init(&bebob->out_conn,
294eb7b3a05STakashi Sakamoto 				  bebob->unit, CMP_OUTPUT, 0);
295eb7b3a05STakashi Sakamoto 	if (err < 0)
296eb7b3a05STakashi Sakamoto 		cmp_connection_destroy(&bebob->in_conn);
297eb7b3a05STakashi Sakamoto end:
298eb7b3a05STakashi Sakamoto 	return err;
299eb7b3a05STakashi Sakamoto }
300eb7b3a05STakashi Sakamoto 
301eb7b3a05STakashi Sakamoto static int
302eb7b3a05STakashi Sakamoto check_connection_used_by_others(struct snd_bebob *bebob, struct amdtp_stream *s)
303eb7b3a05STakashi Sakamoto {
304eb7b3a05STakashi Sakamoto 	struct cmp_connection *conn;
305eb7b3a05STakashi Sakamoto 	bool used;
306eb7b3a05STakashi Sakamoto 	int err;
307eb7b3a05STakashi Sakamoto 
308eb7b3a05STakashi Sakamoto 	if (s == &bebob->tx_stream)
309eb7b3a05STakashi Sakamoto 		conn = &bebob->out_conn;
310eb7b3a05STakashi Sakamoto 	else
311eb7b3a05STakashi Sakamoto 		conn = &bebob->in_conn;
312eb7b3a05STakashi Sakamoto 
313eb7b3a05STakashi Sakamoto 	err = cmp_connection_check_used(conn, &used);
314eb7b3a05STakashi Sakamoto 	if ((err >= 0) && used && !amdtp_stream_running(s)) {
315eb7b3a05STakashi Sakamoto 		dev_err(&bebob->unit->device,
316eb7b3a05STakashi Sakamoto 			"Connection established by others: %cPCR[%d]\n",
317eb7b3a05STakashi Sakamoto 			(conn->direction == CMP_OUTPUT) ? 'o' : 'i',
318eb7b3a05STakashi Sakamoto 			conn->pcr_index);
319eb7b3a05STakashi Sakamoto 		err = -EBUSY;
320eb7b3a05STakashi Sakamoto 	}
321eb7b3a05STakashi Sakamoto 
322eb7b3a05STakashi Sakamoto 	return err;
323eb7b3a05STakashi Sakamoto }
324eb7b3a05STakashi Sakamoto 
325eb7b3a05STakashi Sakamoto static int
326eb7b3a05STakashi Sakamoto make_both_connections(struct snd_bebob *bebob, unsigned int rate)
327eb7b3a05STakashi Sakamoto {
328eb7b3a05STakashi Sakamoto 	int index, pcm_channels, midi_channels, err;
329eb7b3a05STakashi Sakamoto 
330eb7b3a05STakashi Sakamoto 	/* confirm params for both streams */
331eb7b3a05STakashi Sakamoto 	index = get_formation_index(rate);
332eb7b3a05STakashi Sakamoto 	pcm_channels = bebob->tx_stream_formations[index].pcm;
333eb7b3a05STakashi Sakamoto 	midi_channels = bebob->tx_stream_formations[index].midi;
334eb7b3a05STakashi Sakamoto 	amdtp_stream_set_parameters(&bebob->tx_stream,
335eb7b3a05STakashi Sakamoto 				    rate, pcm_channels, midi_channels * 8);
336eb7b3a05STakashi Sakamoto 	pcm_channels = bebob->rx_stream_formations[index].pcm;
337eb7b3a05STakashi Sakamoto 	midi_channels = bebob->rx_stream_formations[index].midi;
338eb7b3a05STakashi Sakamoto 	amdtp_stream_set_parameters(&bebob->rx_stream,
339eb7b3a05STakashi Sakamoto 				    rate, pcm_channels, midi_channels * 8);
340eb7b3a05STakashi Sakamoto 
341eb7b3a05STakashi Sakamoto 	/* establish connections for both streams */
342eb7b3a05STakashi Sakamoto 	err = cmp_connection_establish(&bebob->out_conn,
343eb7b3a05STakashi Sakamoto 			amdtp_stream_get_max_payload(&bebob->tx_stream));
344eb7b3a05STakashi Sakamoto 	if (err < 0)
345eb7b3a05STakashi Sakamoto 		goto end;
346eb7b3a05STakashi Sakamoto 	err = cmp_connection_establish(&bebob->in_conn,
347eb7b3a05STakashi Sakamoto 			amdtp_stream_get_max_payload(&bebob->rx_stream));
348eb7b3a05STakashi Sakamoto 	if (err < 0)
349eb7b3a05STakashi Sakamoto 		cmp_connection_break(&bebob->out_conn);
350eb7b3a05STakashi Sakamoto end:
351eb7b3a05STakashi Sakamoto 	return err;
352eb7b3a05STakashi Sakamoto }
353eb7b3a05STakashi Sakamoto 
354eb7b3a05STakashi Sakamoto static void
355eb7b3a05STakashi Sakamoto break_both_connections(struct snd_bebob *bebob)
356eb7b3a05STakashi Sakamoto {
357eb7b3a05STakashi Sakamoto 	cmp_connection_break(&bebob->in_conn);
358eb7b3a05STakashi Sakamoto 	cmp_connection_break(&bebob->out_conn);
359eb7b3a05STakashi Sakamoto }
360eb7b3a05STakashi Sakamoto 
361eb7b3a05STakashi Sakamoto static void
362eb7b3a05STakashi Sakamoto destroy_both_connections(struct snd_bebob *bebob)
363eb7b3a05STakashi Sakamoto {
364eb7b3a05STakashi Sakamoto 	break_both_connections(bebob);
365eb7b3a05STakashi Sakamoto 
366eb7b3a05STakashi Sakamoto 	cmp_connection_destroy(&bebob->in_conn);
367eb7b3a05STakashi Sakamoto 	cmp_connection_destroy(&bebob->out_conn);
368eb7b3a05STakashi Sakamoto }
369eb7b3a05STakashi Sakamoto 
370eb7b3a05STakashi Sakamoto static int
371eb7b3a05STakashi Sakamoto get_sync_mode(struct snd_bebob *bebob, enum cip_flags *sync_mode)
372eb7b3a05STakashi Sakamoto {
373eb7b3a05STakashi Sakamoto 	/* currently this module doesn't support SYT-Match mode */
374eb7b3a05STakashi Sakamoto 	*sync_mode = CIP_SYNC_TO_DEVICE;
375eb7b3a05STakashi Sakamoto 	return 0;
376eb7b3a05STakashi Sakamoto }
377eb7b3a05STakashi Sakamoto 
378eb7b3a05STakashi Sakamoto static int
379eb7b3a05STakashi Sakamoto start_stream(struct snd_bebob *bebob, struct amdtp_stream *stream,
380eb7b3a05STakashi Sakamoto 	     unsigned int rate)
381eb7b3a05STakashi Sakamoto {
382eb7b3a05STakashi Sakamoto 	struct cmp_connection *conn;
383eb7b3a05STakashi Sakamoto 	int err = 0;
384eb7b3a05STakashi Sakamoto 
385eb7b3a05STakashi Sakamoto 	if (stream == &bebob->rx_stream)
386eb7b3a05STakashi Sakamoto 		conn = &bebob->in_conn;
387eb7b3a05STakashi Sakamoto 	else
388eb7b3a05STakashi Sakamoto 		conn = &bebob->out_conn;
389eb7b3a05STakashi Sakamoto 
390eb7b3a05STakashi Sakamoto 	/* channel mapping */
391eb7b3a05STakashi Sakamoto 	err = map_data_channels(bebob, stream);
392eb7b3a05STakashi Sakamoto 	if (err < 0)
393eb7b3a05STakashi Sakamoto 		goto end;
394eb7b3a05STakashi Sakamoto 
395eb7b3a05STakashi Sakamoto 	/* start amdtp stream */
396eb7b3a05STakashi Sakamoto 	err = amdtp_stream_start(stream,
397eb7b3a05STakashi Sakamoto 				 conn->resources.channel,
398eb7b3a05STakashi Sakamoto 				 conn->speed);
399eb7b3a05STakashi Sakamoto end:
400eb7b3a05STakashi Sakamoto 	return err;
401eb7b3a05STakashi Sakamoto }
402eb7b3a05STakashi Sakamoto 
403eb7b3a05STakashi Sakamoto int snd_bebob_stream_init_duplex(struct snd_bebob *bebob)
404eb7b3a05STakashi Sakamoto {
405eb7b3a05STakashi Sakamoto 	int err;
406eb7b3a05STakashi Sakamoto 
407eb7b3a05STakashi Sakamoto 	err = init_both_connections(bebob);
408eb7b3a05STakashi Sakamoto 	if (err < 0)
409eb7b3a05STakashi Sakamoto 		goto end;
410eb7b3a05STakashi Sakamoto 
411eb7b3a05STakashi Sakamoto 	err = amdtp_stream_init(&bebob->tx_stream, bebob->unit,
412eb7b3a05STakashi Sakamoto 				AMDTP_IN_STREAM, CIP_BLOCKING);
413eb7b3a05STakashi Sakamoto 	if (err < 0) {
414eb7b3a05STakashi Sakamoto 		amdtp_stream_destroy(&bebob->tx_stream);
415eb7b3a05STakashi Sakamoto 		destroy_both_connections(bebob);
416eb7b3a05STakashi Sakamoto 		goto end;
417eb7b3a05STakashi Sakamoto 	}
418eb7b3a05STakashi Sakamoto 
419eb7b3a05STakashi Sakamoto 	err = amdtp_stream_init(&bebob->rx_stream, bebob->unit,
420eb7b3a05STakashi Sakamoto 				AMDTP_OUT_STREAM, CIP_BLOCKING);
421eb7b3a05STakashi Sakamoto 	if (err < 0) {
422eb7b3a05STakashi Sakamoto 		amdtp_stream_destroy(&bebob->tx_stream);
423eb7b3a05STakashi Sakamoto 		amdtp_stream_destroy(&bebob->rx_stream);
424eb7b3a05STakashi Sakamoto 		destroy_both_connections(bebob);
425eb7b3a05STakashi Sakamoto 	}
426eb7b3a05STakashi Sakamoto end:
427eb7b3a05STakashi Sakamoto 	return err;
428eb7b3a05STakashi Sakamoto }
429eb7b3a05STakashi Sakamoto 
430eb7b3a05STakashi Sakamoto int snd_bebob_stream_start_duplex(struct snd_bebob *bebob, int rate)
431eb7b3a05STakashi Sakamoto {
432eb7b3a05STakashi Sakamoto 	struct amdtp_stream *master, *slave;
433eb7b3a05STakashi Sakamoto 	atomic_t *slave_substreams;
434eb7b3a05STakashi Sakamoto 	enum cip_flags sync_mode;
435eb7b3a05STakashi Sakamoto 	unsigned int curr_rate;
436eb7b3a05STakashi Sakamoto 	int err = 0;
437eb7b3a05STakashi Sakamoto 
438eb7b3a05STakashi Sakamoto 	mutex_lock(&bebob->mutex);
439eb7b3a05STakashi Sakamoto 
440eb7b3a05STakashi Sakamoto 	/* Need no substreams */
441eb7b3a05STakashi Sakamoto 	if (atomic_read(&bebob->playback_substreams) == 0 &&
442eb7b3a05STakashi Sakamoto 	    atomic_read(&bebob->capture_substreams)  == 0)
443eb7b3a05STakashi Sakamoto 		goto end;
444eb7b3a05STakashi Sakamoto 
445eb7b3a05STakashi Sakamoto 	err = get_sync_mode(bebob, &sync_mode);
446eb7b3a05STakashi Sakamoto 	if (err < 0)
447eb7b3a05STakashi Sakamoto 		goto end;
448eb7b3a05STakashi Sakamoto 	if (sync_mode == CIP_SYNC_TO_DEVICE) {
449eb7b3a05STakashi Sakamoto 		master = &bebob->tx_stream;
450eb7b3a05STakashi Sakamoto 		slave  = &bebob->rx_stream;
451eb7b3a05STakashi Sakamoto 		slave_substreams = &bebob->playback_substreams;
452eb7b3a05STakashi Sakamoto 	} else {
453eb7b3a05STakashi Sakamoto 		master = &bebob->rx_stream;
454eb7b3a05STakashi Sakamoto 		slave  = &bebob->tx_stream;
455eb7b3a05STakashi Sakamoto 		slave_substreams = &bebob->capture_substreams;
456eb7b3a05STakashi Sakamoto 	}
457eb7b3a05STakashi Sakamoto 
458eb7b3a05STakashi Sakamoto 	/*
459eb7b3a05STakashi Sakamoto 	 * Considering JACK/FFADO streaming:
460eb7b3a05STakashi Sakamoto 	 * TODO: This can be removed hwdep functionality becomes popular.
461eb7b3a05STakashi Sakamoto 	 */
462eb7b3a05STakashi Sakamoto 	err = check_connection_used_by_others(bebob, master);
463eb7b3a05STakashi Sakamoto 	if (err < 0)
464eb7b3a05STakashi Sakamoto 		goto end;
465eb7b3a05STakashi Sakamoto 
466eb7b3a05STakashi Sakamoto 	/* packet queueing error */
467eb7b3a05STakashi Sakamoto 	if (amdtp_streaming_error(master)) {
468eb7b3a05STakashi Sakamoto 		amdtp_stream_stop(master);
469eb7b3a05STakashi Sakamoto 		amdtp_stream_stop(slave);
470eb7b3a05STakashi Sakamoto 	}
471eb7b3a05STakashi Sakamoto 	if (amdtp_streaming_error(slave))
472eb7b3a05STakashi Sakamoto 		amdtp_stream_stop(slave);
473eb7b3a05STakashi Sakamoto 
474eb7b3a05STakashi Sakamoto 	/* stop streams if rate is different */
475eb7b3a05STakashi Sakamoto 	err = snd_bebob_stream_get_rate(bebob, &curr_rate);
476eb7b3a05STakashi Sakamoto 	if (err < 0) {
477eb7b3a05STakashi Sakamoto 		dev_err(&bebob->unit->device,
478eb7b3a05STakashi Sakamoto 			"fail to get sampling rate: %d\n", err);
479eb7b3a05STakashi Sakamoto 		goto end;
480eb7b3a05STakashi Sakamoto 	}
481eb7b3a05STakashi Sakamoto 	if (rate == 0)
482eb7b3a05STakashi Sakamoto 		rate = curr_rate;
483eb7b3a05STakashi Sakamoto 	if (rate != curr_rate) {
484eb7b3a05STakashi Sakamoto 		amdtp_stream_stop(master);
485eb7b3a05STakashi Sakamoto 		amdtp_stream_stop(slave);
486eb7b3a05STakashi Sakamoto 		break_both_connections(bebob);
487eb7b3a05STakashi Sakamoto 	}
488eb7b3a05STakashi Sakamoto 
489eb7b3a05STakashi Sakamoto 	/* master should be always running */
490eb7b3a05STakashi Sakamoto 	if (!amdtp_stream_running(master)) {
491eb7b3a05STakashi Sakamoto 		amdtp_stream_set_sync(sync_mode, master, slave);
492eb7b3a05STakashi Sakamoto 		bebob->master = master;
493eb7b3a05STakashi Sakamoto 
494eb7b3a05STakashi Sakamoto 		/*
495eb7b3a05STakashi Sakamoto 		 * NOTE:
496eb7b3a05STakashi Sakamoto 		 * If establishing connections at first, Yamaha GO46
497eb7b3a05STakashi Sakamoto 		 * (and maybe Terratec X24) don't generate sound.
498eb7b3a05STakashi Sakamoto 		 */
499eb7b3a05STakashi Sakamoto 		err = snd_bebob_stream_set_rate(bebob, rate);
500eb7b3a05STakashi Sakamoto 		if (err < 0) {
501eb7b3a05STakashi Sakamoto 			dev_err(&bebob->unit->device,
502eb7b3a05STakashi Sakamoto 				"fail to set sampling rate: %d\n",
503eb7b3a05STakashi Sakamoto 				err);
504eb7b3a05STakashi Sakamoto 			goto end;
505eb7b3a05STakashi Sakamoto 		}
506eb7b3a05STakashi Sakamoto 
507eb7b3a05STakashi Sakamoto 		err = make_both_connections(bebob, rate);
508eb7b3a05STakashi Sakamoto 		if (err < 0)
509eb7b3a05STakashi Sakamoto 			goto end;
510eb7b3a05STakashi Sakamoto 
511eb7b3a05STakashi Sakamoto 		err = start_stream(bebob, master, rate);
512eb7b3a05STakashi Sakamoto 		if (err < 0) {
513eb7b3a05STakashi Sakamoto 			dev_err(&bebob->unit->device,
514eb7b3a05STakashi Sakamoto 				"fail to run AMDTP master stream:%d\n", err);
515eb7b3a05STakashi Sakamoto 			break_both_connections(bebob);
516eb7b3a05STakashi Sakamoto 			goto end;
517eb7b3a05STakashi Sakamoto 		}
518eb7b3a05STakashi Sakamoto 
519eb7b3a05STakashi Sakamoto 		/* wait first callback */
520eb7b3a05STakashi Sakamoto 		if (!amdtp_stream_wait_callback(master, CALLBACK_TIMEOUT)) {
521eb7b3a05STakashi Sakamoto 			amdtp_stream_stop(master);
522eb7b3a05STakashi Sakamoto 			break_both_connections(bebob);
523eb7b3a05STakashi Sakamoto 			err = -ETIMEDOUT;
524eb7b3a05STakashi Sakamoto 			goto end;
525eb7b3a05STakashi Sakamoto 		}
526eb7b3a05STakashi Sakamoto 	}
527eb7b3a05STakashi Sakamoto 
528eb7b3a05STakashi Sakamoto 	/* start slave if needed */
529eb7b3a05STakashi Sakamoto 	if (atomic_read(slave_substreams) > 0 && !amdtp_stream_running(slave)) {
530eb7b3a05STakashi Sakamoto 		err = start_stream(bebob, slave, rate);
531eb7b3a05STakashi Sakamoto 		if (err < 0) {
532eb7b3a05STakashi Sakamoto 			dev_err(&bebob->unit->device,
533eb7b3a05STakashi Sakamoto 				"fail to run AMDTP slave stream:%d\n", err);
534eb7b3a05STakashi Sakamoto 			amdtp_stream_stop(master);
535eb7b3a05STakashi Sakamoto 			break_both_connections(bebob);
536eb7b3a05STakashi Sakamoto 			goto end;
537eb7b3a05STakashi Sakamoto 		}
538eb7b3a05STakashi Sakamoto 
539eb7b3a05STakashi Sakamoto 		/* wait first callback */
540eb7b3a05STakashi Sakamoto 		if (!amdtp_stream_wait_callback(slave, CALLBACK_TIMEOUT)) {
541eb7b3a05STakashi Sakamoto 			amdtp_stream_stop(slave);
542eb7b3a05STakashi Sakamoto 			amdtp_stream_stop(master);
543eb7b3a05STakashi Sakamoto 			break_both_connections(bebob);
544eb7b3a05STakashi Sakamoto 			err = -ETIMEDOUT;
545eb7b3a05STakashi Sakamoto 		}
546eb7b3a05STakashi Sakamoto 	}
547eb7b3a05STakashi Sakamoto end:
548eb7b3a05STakashi Sakamoto 	mutex_unlock(&bebob->mutex);
549eb7b3a05STakashi Sakamoto 	return err;
550eb7b3a05STakashi Sakamoto }
551eb7b3a05STakashi Sakamoto 
552eb7b3a05STakashi Sakamoto void snd_bebob_stream_stop_duplex(struct snd_bebob *bebob)
553eb7b3a05STakashi Sakamoto {
554eb7b3a05STakashi Sakamoto 	struct amdtp_stream *master, *slave;
555eb7b3a05STakashi Sakamoto 	atomic_t *master_substreams, *slave_substreams;
556eb7b3a05STakashi Sakamoto 
557eb7b3a05STakashi Sakamoto 	mutex_lock(&bebob->mutex);
558eb7b3a05STakashi Sakamoto 
559eb7b3a05STakashi Sakamoto 	if (bebob->master == &bebob->rx_stream) {
560eb7b3a05STakashi Sakamoto 		slave  = &bebob->tx_stream;
561eb7b3a05STakashi Sakamoto 		master = &bebob->rx_stream;
562eb7b3a05STakashi Sakamoto 		slave_substreams  = &bebob->capture_substreams;
563eb7b3a05STakashi Sakamoto 		master_substreams = &bebob->playback_substreams;
564eb7b3a05STakashi Sakamoto 	} else {
565eb7b3a05STakashi Sakamoto 		slave  = &bebob->rx_stream;
566eb7b3a05STakashi Sakamoto 		master = &bebob->tx_stream;
567eb7b3a05STakashi Sakamoto 		slave_substreams  = &bebob->playback_substreams;
568eb7b3a05STakashi Sakamoto 		master_substreams = &bebob->capture_substreams;
569eb7b3a05STakashi Sakamoto 	}
570eb7b3a05STakashi Sakamoto 
571eb7b3a05STakashi Sakamoto 	if (atomic_read(slave_substreams) == 0) {
572eb7b3a05STakashi Sakamoto 		amdtp_stream_pcm_abort(slave);
573eb7b3a05STakashi Sakamoto 		amdtp_stream_stop(slave);
574eb7b3a05STakashi Sakamoto 
575eb7b3a05STakashi Sakamoto 		if (atomic_read(master_substreams) == 0) {
576eb7b3a05STakashi Sakamoto 			amdtp_stream_pcm_abort(master);
577eb7b3a05STakashi Sakamoto 			amdtp_stream_stop(master);
578eb7b3a05STakashi Sakamoto 			break_both_connections(bebob);
579eb7b3a05STakashi Sakamoto 		}
580eb7b3a05STakashi Sakamoto 	}
581eb7b3a05STakashi Sakamoto 
582eb7b3a05STakashi Sakamoto 	mutex_unlock(&bebob->mutex);
583eb7b3a05STakashi Sakamoto }
584eb7b3a05STakashi Sakamoto 
585eb7b3a05STakashi Sakamoto void snd_bebob_stream_update_duplex(struct snd_bebob *bebob)
586eb7b3a05STakashi Sakamoto {
587eb7b3a05STakashi Sakamoto 	/* vs. XRUN recovery due to discontinuity at bus reset */
588eb7b3a05STakashi Sakamoto 	mutex_lock(&bebob->mutex);
589eb7b3a05STakashi Sakamoto 
590eb7b3a05STakashi Sakamoto 	if ((cmp_connection_update(&bebob->in_conn) < 0) ||
591eb7b3a05STakashi Sakamoto 	    (cmp_connection_update(&bebob->out_conn) < 0)) {
592eb7b3a05STakashi Sakamoto 		amdtp_stream_pcm_abort(&bebob->rx_stream);
593eb7b3a05STakashi Sakamoto 		amdtp_stream_pcm_abort(&bebob->tx_stream);
594eb7b3a05STakashi Sakamoto 		amdtp_stream_stop(&bebob->rx_stream);
595eb7b3a05STakashi Sakamoto 		amdtp_stream_stop(&bebob->tx_stream);
596eb7b3a05STakashi Sakamoto 		break_both_connections(bebob);
597eb7b3a05STakashi Sakamoto 	} else {
598eb7b3a05STakashi Sakamoto 		amdtp_stream_update(&bebob->rx_stream);
599eb7b3a05STakashi Sakamoto 		amdtp_stream_update(&bebob->tx_stream);
600eb7b3a05STakashi Sakamoto 	}
601eb7b3a05STakashi Sakamoto 
602eb7b3a05STakashi Sakamoto 	mutex_unlock(&bebob->mutex);
603eb7b3a05STakashi Sakamoto }
604eb7b3a05STakashi Sakamoto 
605eb7b3a05STakashi Sakamoto void snd_bebob_stream_destroy_duplex(struct snd_bebob *bebob)
606eb7b3a05STakashi Sakamoto {
607eb7b3a05STakashi Sakamoto 	mutex_lock(&bebob->mutex);
608eb7b3a05STakashi Sakamoto 
609eb7b3a05STakashi Sakamoto 	amdtp_stream_pcm_abort(&bebob->rx_stream);
610eb7b3a05STakashi Sakamoto 	amdtp_stream_pcm_abort(&bebob->tx_stream);
611eb7b3a05STakashi Sakamoto 
612eb7b3a05STakashi Sakamoto 	amdtp_stream_stop(&bebob->rx_stream);
613eb7b3a05STakashi Sakamoto 	amdtp_stream_stop(&bebob->tx_stream);
614eb7b3a05STakashi Sakamoto 
615eb7b3a05STakashi Sakamoto 	amdtp_stream_destroy(&bebob->rx_stream);
616eb7b3a05STakashi Sakamoto 	amdtp_stream_destroy(&bebob->tx_stream);
617eb7b3a05STakashi Sakamoto 
618eb7b3a05STakashi Sakamoto 	destroy_both_connections(bebob);
619eb7b3a05STakashi Sakamoto 
620eb7b3a05STakashi Sakamoto 	mutex_unlock(&bebob->mutex);
621eb7b3a05STakashi Sakamoto }
622eb7b3a05STakashi Sakamoto 
623eb7b3a05STakashi Sakamoto /*
624eb7b3a05STakashi Sakamoto  * See: Table 50: Extended Stream Format Info Format Hierarchy Level 2’
625eb7b3a05STakashi Sakamoto  * in Additional AVC commands (Nov 2003, BridgeCo)
626eb7b3a05STakashi Sakamoto  * Also 'Clause 12 AM824 sequence adaption layers' in IEC 61883-6:2005
627eb7b3a05STakashi Sakamoto  */
628eb7b3a05STakashi Sakamoto static int
629eb7b3a05STakashi Sakamoto parse_stream_formation(u8 *buf, unsigned int len,
630eb7b3a05STakashi Sakamoto 		       struct snd_bebob_stream_formation *formation)
631eb7b3a05STakashi Sakamoto {
632eb7b3a05STakashi Sakamoto 	unsigned int i, e, channels, format;
633eb7b3a05STakashi Sakamoto 
634eb7b3a05STakashi Sakamoto 	/*
635eb7b3a05STakashi Sakamoto 	 * this module can support a hierarchy combination that:
636eb7b3a05STakashi Sakamoto 	 *  Root:	Audio and Music (0x90)
637eb7b3a05STakashi Sakamoto 	 *  Level 1:	AM824 Compound  (0x40)
638eb7b3a05STakashi Sakamoto 	 */
639eb7b3a05STakashi Sakamoto 	if ((buf[0] != 0x90) || (buf[1] != 0x40))
640eb7b3a05STakashi Sakamoto 		return -ENOSYS;
641eb7b3a05STakashi Sakamoto 
642eb7b3a05STakashi Sakamoto 	/* check sampling rate */
643eb7b3a05STakashi Sakamoto 	for (i = 0; i < ARRAY_SIZE(bridgeco_freq_table); i++) {
644eb7b3a05STakashi Sakamoto 		if (buf[2] == bridgeco_freq_table[i])
645eb7b3a05STakashi Sakamoto 			break;
646eb7b3a05STakashi Sakamoto 	}
647eb7b3a05STakashi Sakamoto 	if (i == sizeof(bridgeco_freq_table))
648eb7b3a05STakashi Sakamoto 		return -ENOSYS;
649eb7b3a05STakashi Sakamoto 
650eb7b3a05STakashi Sakamoto 	/* Avoid double count by different entries for the same rate. */
651eb7b3a05STakashi Sakamoto 	memset(&formation[i], 0, sizeof(struct snd_bebob_stream_formation));
652eb7b3a05STakashi Sakamoto 
653eb7b3a05STakashi Sakamoto 	for (e = 0; e < buf[4]; e++) {
654eb7b3a05STakashi Sakamoto 		channels = buf[5 + e * 2];
655eb7b3a05STakashi Sakamoto 		format = buf[6 + e * 2];
656eb7b3a05STakashi Sakamoto 
657eb7b3a05STakashi Sakamoto 		switch (format) {
658eb7b3a05STakashi Sakamoto 		/* IEC 60958-3, currently handle as MBLA */
659eb7b3a05STakashi Sakamoto 		case 0x00:
660eb7b3a05STakashi Sakamoto 		/* Multi bit linear audio */
661eb7b3a05STakashi Sakamoto 		case 0x06:	/* Raw */
662eb7b3a05STakashi Sakamoto 			formation[i].pcm += channels;
663eb7b3a05STakashi Sakamoto 			break;
664eb7b3a05STakashi Sakamoto 		/* MIDI Conformant */
665eb7b3a05STakashi Sakamoto 		case 0x0d:
666eb7b3a05STakashi Sakamoto 			formation[i].midi += channels;
667eb7b3a05STakashi Sakamoto 			break;
668eb7b3a05STakashi Sakamoto 		/* IEC 61937-3 to 7 */
669eb7b3a05STakashi Sakamoto 		case 0x01:
670eb7b3a05STakashi Sakamoto 		case 0x02:
671eb7b3a05STakashi Sakamoto 		case 0x03:
672eb7b3a05STakashi Sakamoto 		case 0x04:
673eb7b3a05STakashi Sakamoto 		case 0x05:
674eb7b3a05STakashi Sakamoto 		/* Multi bit linear audio */
675eb7b3a05STakashi Sakamoto 		case 0x07:	/* DVD-Audio */
676eb7b3a05STakashi Sakamoto 		case 0x0c:	/* High Precision */
677eb7b3a05STakashi Sakamoto 		/* One Bit Audio */
678eb7b3a05STakashi Sakamoto 		case 0x08:	/* (Plain) Raw */
679eb7b3a05STakashi Sakamoto 		case 0x09:	/* (Plain) SACD */
680eb7b3a05STakashi Sakamoto 		case 0x0a:	/* (Encoded) Raw */
681eb7b3a05STakashi Sakamoto 		case 0x0b:	/* (Encoded) SACD */
682eb7b3a05STakashi Sakamoto 		/* Synchronization Stream (Stereo Raw audio) */
683eb7b3a05STakashi Sakamoto 		case 0x40:
684eb7b3a05STakashi Sakamoto 		/* Don't care */
685eb7b3a05STakashi Sakamoto 		case 0xff:
686eb7b3a05STakashi Sakamoto 		default:
687eb7b3a05STakashi Sakamoto 			return -ENOSYS;	/* not supported */
688eb7b3a05STakashi Sakamoto 		}
689eb7b3a05STakashi Sakamoto 	}
690eb7b3a05STakashi Sakamoto 
691eb7b3a05STakashi Sakamoto 	if (formation[i].pcm  > AMDTP_MAX_CHANNELS_FOR_PCM ||
692eb7b3a05STakashi Sakamoto 	    formation[i].midi > AMDTP_MAX_CHANNELS_FOR_MIDI)
693eb7b3a05STakashi Sakamoto 		return -ENOSYS;
694eb7b3a05STakashi Sakamoto 
695eb7b3a05STakashi Sakamoto 	return 0;
696eb7b3a05STakashi Sakamoto }
697eb7b3a05STakashi Sakamoto 
698eb7b3a05STakashi Sakamoto static int
699eb7b3a05STakashi Sakamoto fill_stream_formations(struct snd_bebob *bebob, enum avc_bridgeco_plug_dir dir,
700eb7b3a05STakashi Sakamoto 		       unsigned short pid)
701eb7b3a05STakashi Sakamoto {
702eb7b3a05STakashi Sakamoto 	u8 *buf;
703eb7b3a05STakashi Sakamoto 	struct snd_bebob_stream_formation *formations;
704eb7b3a05STakashi Sakamoto 	unsigned int len, eid;
705eb7b3a05STakashi Sakamoto 	u8 addr[AVC_BRIDGECO_ADDR_BYTES];
706eb7b3a05STakashi Sakamoto 	int err;
707eb7b3a05STakashi Sakamoto 
708eb7b3a05STakashi Sakamoto 	buf = kmalloc(FORMAT_MAXIMUM_LENGTH, GFP_KERNEL);
709eb7b3a05STakashi Sakamoto 	if (buf == NULL)
710eb7b3a05STakashi Sakamoto 		return -ENOMEM;
711eb7b3a05STakashi Sakamoto 
712eb7b3a05STakashi Sakamoto 	if (dir == AVC_BRIDGECO_PLUG_DIR_IN)
713eb7b3a05STakashi Sakamoto 		formations = bebob->rx_stream_formations;
714eb7b3a05STakashi Sakamoto 	else
715eb7b3a05STakashi Sakamoto 		formations = bebob->tx_stream_formations;
716eb7b3a05STakashi Sakamoto 
717eb7b3a05STakashi Sakamoto 	for (eid = 0; eid < SND_BEBOB_STRM_FMT_ENTRIES; eid++) {
718eb7b3a05STakashi Sakamoto 		len = FORMAT_MAXIMUM_LENGTH;
719eb7b3a05STakashi Sakamoto 		avc_bridgeco_fill_unit_addr(addr, dir,
720eb7b3a05STakashi Sakamoto 					    AVC_BRIDGECO_PLUG_UNIT_ISOC, pid);
721eb7b3a05STakashi Sakamoto 		err = avc_bridgeco_get_plug_strm_fmt(bebob->unit, addr, buf,
722eb7b3a05STakashi Sakamoto 						     &len, eid);
723eb7b3a05STakashi Sakamoto 		/* No entries remained. */
724eb7b3a05STakashi Sakamoto 		if (err == -EINVAL && eid > 0) {
725eb7b3a05STakashi Sakamoto 			err = 0;
726eb7b3a05STakashi Sakamoto 			break;
727eb7b3a05STakashi Sakamoto 		} else if (err < 0) {
728eb7b3a05STakashi Sakamoto 			dev_err(&bebob->unit->device,
729eb7b3a05STakashi Sakamoto 			"fail to get stream format %d for isoc %s plug %d:%d\n",
730eb7b3a05STakashi Sakamoto 				eid,
731eb7b3a05STakashi Sakamoto 				(dir == AVC_BRIDGECO_PLUG_DIR_IN) ? "in" :
732eb7b3a05STakashi Sakamoto 								    "out",
733eb7b3a05STakashi Sakamoto 				pid, err);
734eb7b3a05STakashi Sakamoto 			break;
735eb7b3a05STakashi Sakamoto 		}
736eb7b3a05STakashi Sakamoto 
737eb7b3a05STakashi Sakamoto 		err = parse_stream_formation(buf, len, formations);
738eb7b3a05STakashi Sakamoto 		if (err < 0)
739eb7b3a05STakashi Sakamoto 			break;
740eb7b3a05STakashi Sakamoto 	}
741eb7b3a05STakashi Sakamoto 
742eb7b3a05STakashi Sakamoto 	kfree(buf);
743eb7b3a05STakashi Sakamoto 	return err;
744eb7b3a05STakashi Sakamoto }
745eb7b3a05STakashi Sakamoto 
746eb7b3a05STakashi Sakamoto static int
747eb7b3a05STakashi Sakamoto seek_msu_sync_input_plug(struct snd_bebob *bebob)
748eb7b3a05STakashi Sakamoto {
749eb7b3a05STakashi Sakamoto 	u8 plugs[AVC_PLUG_INFO_BUF_BYTES], addr[AVC_BRIDGECO_ADDR_BYTES];
750eb7b3a05STakashi Sakamoto 	unsigned int i, type;
751eb7b3a05STakashi Sakamoto 	int err;
752eb7b3a05STakashi Sakamoto 
753eb7b3a05STakashi Sakamoto 	/* Get the number of Music Sub Unit for both direction. */
754eb7b3a05STakashi Sakamoto 	err = avc_general_get_plug_info(bebob->unit, 0x0c, 0x00, 0x00, plugs);
755eb7b3a05STakashi Sakamoto 	if (err < 0) {
756eb7b3a05STakashi Sakamoto 		dev_err(&bebob->unit->device,
757eb7b3a05STakashi Sakamoto 			"fail to get info for MSU in/out plugs: %d\n",
758eb7b3a05STakashi Sakamoto 			err);
759eb7b3a05STakashi Sakamoto 		goto end;
760eb7b3a05STakashi Sakamoto 	}
761eb7b3a05STakashi Sakamoto 
762eb7b3a05STakashi Sakamoto 	/* seek destination plugs for 'MSU sync input' */
763eb7b3a05STakashi Sakamoto 	bebob->sync_input_plug = -1;
764eb7b3a05STakashi Sakamoto 	for (i = 0; i < plugs[0]; i++) {
765eb7b3a05STakashi Sakamoto 		avc_bridgeco_fill_msu_addr(addr, AVC_BRIDGECO_PLUG_DIR_IN, i);
766eb7b3a05STakashi Sakamoto 		err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type);
767eb7b3a05STakashi Sakamoto 		if (err < 0) {
768eb7b3a05STakashi Sakamoto 			dev_err(&bebob->unit->device,
769eb7b3a05STakashi Sakamoto 				"fail to get type for MSU in plug %d: %d\n",
770eb7b3a05STakashi Sakamoto 				i, err);
771eb7b3a05STakashi Sakamoto 			goto end;
772eb7b3a05STakashi Sakamoto 		}
773eb7b3a05STakashi Sakamoto 
774eb7b3a05STakashi Sakamoto 		if (type == AVC_BRIDGECO_PLUG_TYPE_SYNC) {
775eb7b3a05STakashi Sakamoto 			bebob->sync_input_plug = i;
776eb7b3a05STakashi Sakamoto 			break;
777eb7b3a05STakashi Sakamoto 		}
778eb7b3a05STakashi Sakamoto 	}
779eb7b3a05STakashi Sakamoto end:
780eb7b3a05STakashi Sakamoto 	return err;
781eb7b3a05STakashi Sakamoto }
782eb7b3a05STakashi Sakamoto 
783eb7b3a05STakashi Sakamoto int snd_bebob_stream_discover(struct snd_bebob *bebob)
784eb7b3a05STakashi Sakamoto {
785eb7b3a05STakashi Sakamoto 	u8 plugs[AVC_PLUG_INFO_BUF_BYTES], addr[AVC_BRIDGECO_ADDR_BYTES];
786eb7b3a05STakashi Sakamoto 	enum avc_bridgeco_plug_type type;
787eb7b3a05STakashi Sakamoto 	unsigned int i;
788eb7b3a05STakashi Sakamoto 	int err;
789eb7b3a05STakashi Sakamoto 
790eb7b3a05STakashi Sakamoto 	/* the number of plugs for isoc in/out, ext in/out  */
791eb7b3a05STakashi Sakamoto 	err = avc_general_get_plug_info(bebob->unit, 0x1f, 0x07, 0x00, plugs);
792eb7b3a05STakashi Sakamoto 	if (err < 0) {
793eb7b3a05STakashi Sakamoto 		dev_err(&bebob->unit->device,
794eb7b3a05STakashi Sakamoto 		"fail to get info for isoc/external in/out plugs: %d\n",
795eb7b3a05STakashi Sakamoto 			err);
796eb7b3a05STakashi Sakamoto 		goto end;
797eb7b3a05STakashi Sakamoto 	}
798eb7b3a05STakashi Sakamoto 
799eb7b3a05STakashi Sakamoto 	/*
800eb7b3a05STakashi Sakamoto 	 * This module supports at least one isoc input plug and one isoc
801eb7b3a05STakashi Sakamoto 	 * output plug.
802eb7b3a05STakashi Sakamoto 	 */
803eb7b3a05STakashi Sakamoto 	if ((plugs[0] == 0) || (plugs[1] == 0)) {
804eb7b3a05STakashi Sakamoto 		err = -ENOSYS;
805eb7b3a05STakashi Sakamoto 		goto end;
806eb7b3a05STakashi Sakamoto 	}
807eb7b3a05STakashi Sakamoto 
808eb7b3a05STakashi Sakamoto 	avc_bridgeco_fill_unit_addr(addr, AVC_BRIDGECO_PLUG_DIR_IN,
809eb7b3a05STakashi Sakamoto 				    AVC_BRIDGECO_PLUG_UNIT_ISOC, 0);
810eb7b3a05STakashi Sakamoto 	err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type);
811eb7b3a05STakashi Sakamoto 	if (err < 0) {
812eb7b3a05STakashi Sakamoto 		dev_err(&bebob->unit->device,
813eb7b3a05STakashi Sakamoto 			"fail to get type for isoc in plug 0: %d\n", err);
814eb7b3a05STakashi Sakamoto 		goto end;
815eb7b3a05STakashi Sakamoto 	} else if (type != AVC_BRIDGECO_PLUG_TYPE_ISOC) {
816eb7b3a05STakashi Sakamoto 		err = -ENOSYS;
817eb7b3a05STakashi Sakamoto 		goto end;
818eb7b3a05STakashi Sakamoto 	}
819eb7b3a05STakashi Sakamoto 	err = fill_stream_formations(bebob, AVC_BRIDGECO_PLUG_DIR_IN, 0);
820eb7b3a05STakashi Sakamoto 	if (err < 0)
821eb7b3a05STakashi Sakamoto 		goto end;
822eb7b3a05STakashi Sakamoto 
823eb7b3a05STakashi Sakamoto 	avc_bridgeco_fill_unit_addr(addr, AVC_BRIDGECO_PLUG_DIR_OUT,
824eb7b3a05STakashi Sakamoto 				    AVC_BRIDGECO_PLUG_UNIT_ISOC, 0);
825eb7b3a05STakashi Sakamoto 	err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type);
826eb7b3a05STakashi Sakamoto 	if (err < 0) {
827eb7b3a05STakashi Sakamoto 		dev_err(&bebob->unit->device,
828eb7b3a05STakashi Sakamoto 			"fail to get type for isoc out plug 0: %d\n", err);
829eb7b3a05STakashi Sakamoto 		goto end;
830eb7b3a05STakashi Sakamoto 	} else if (type != AVC_BRIDGECO_PLUG_TYPE_ISOC) {
831eb7b3a05STakashi Sakamoto 		err = -ENOSYS;
832eb7b3a05STakashi Sakamoto 		goto end;
833eb7b3a05STakashi Sakamoto 	}
834eb7b3a05STakashi Sakamoto 	err = fill_stream_formations(bebob, AVC_BRIDGECO_PLUG_DIR_OUT, 0);
835eb7b3a05STakashi Sakamoto 	if (err < 0)
836eb7b3a05STakashi Sakamoto 		goto end;
837eb7b3a05STakashi Sakamoto 
838eb7b3a05STakashi Sakamoto 	/* count external input plugs for MIDI */
839eb7b3a05STakashi Sakamoto 	bebob->midi_input_ports = 0;
840eb7b3a05STakashi Sakamoto 	for (i = 0; i < plugs[2]; i++) {
841eb7b3a05STakashi Sakamoto 		avc_bridgeco_fill_unit_addr(addr, AVC_BRIDGECO_PLUG_DIR_IN,
842eb7b3a05STakashi Sakamoto 					    AVC_BRIDGECO_PLUG_UNIT_EXT, i);
843eb7b3a05STakashi Sakamoto 		err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type);
844eb7b3a05STakashi Sakamoto 		if (err < 0) {
845eb7b3a05STakashi Sakamoto 			dev_err(&bebob->unit->device,
846eb7b3a05STakashi Sakamoto 			"fail to get type for external in plug %d: %d\n",
847eb7b3a05STakashi Sakamoto 				i, err);
848eb7b3a05STakashi Sakamoto 			goto end;
849eb7b3a05STakashi Sakamoto 		} else if (type == AVC_BRIDGECO_PLUG_TYPE_MIDI) {
850eb7b3a05STakashi Sakamoto 			bebob->midi_input_ports++;
851eb7b3a05STakashi Sakamoto 		}
852eb7b3a05STakashi Sakamoto 	}
853eb7b3a05STakashi Sakamoto 
854eb7b3a05STakashi Sakamoto 	/* count external output plugs for MIDI */
855eb7b3a05STakashi Sakamoto 	bebob->midi_output_ports = 0;
856eb7b3a05STakashi Sakamoto 	for (i = 0; i < plugs[3]; i++) {
857eb7b3a05STakashi Sakamoto 		avc_bridgeco_fill_unit_addr(addr, AVC_BRIDGECO_PLUG_DIR_OUT,
858eb7b3a05STakashi Sakamoto 					    AVC_BRIDGECO_PLUG_UNIT_EXT, i);
859eb7b3a05STakashi Sakamoto 		err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type);
860eb7b3a05STakashi Sakamoto 		if (err < 0) {
861eb7b3a05STakashi Sakamoto 			dev_err(&bebob->unit->device,
862eb7b3a05STakashi Sakamoto 			"fail to get type for external out plug %d: %d\n",
863eb7b3a05STakashi Sakamoto 				i, err);
864eb7b3a05STakashi Sakamoto 			goto end;
865eb7b3a05STakashi Sakamoto 		} else if (type == AVC_BRIDGECO_PLUG_TYPE_MIDI) {
866eb7b3a05STakashi Sakamoto 			bebob->midi_output_ports++;
867eb7b3a05STakashi Sakamoto 		}
868eb7b3a05STakashi Sakamoto 	}
869eb7b3a05STakashi Sakamoto 
870eb7b3a05STakashi Sakamoto 	/* for check source of clock later */
871eb7b3a05STakashi Sakamoto 	err = seek_msu_sync_input_plug(bebob);
872eb7b3a05STakashi Sakamoto end:
873eb7b3a05STakashi Sakamoto 	return err;
874eb7b3a05STakashi Sakamoto }
875