1da607e19SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2eb7b3a05STakashi Sakamoto /*
3eb7b3a05STakashi Sakamoto * bebob_stream.c - a part of driver for BeBoB based devices
4eb7b3a05STakashi Sakamoto *
5eb7b3a05STakashi Sakamoto * Copyright (c) 2013-2014 Takashi Sakamoto
6eb7b3a05STakashi Sakamoto */
7eb7b3a05STakashi Sakamoto
8eb7b3a05STakashi Sakamoto #include "./bebob.h"
9eb7b3a05STakashi Sakamoto
105ec85c19STakashi Sakamoto #define READY_TIMEOUT_MS 4000
11eb7b3a05STakashi Sakamoto
12eb7b3a05STakashi Sakamoto /*
13eb7b3a05STakashi Sakamoto * NOTE;
14eb7b3a05STakashi Sakamoto * For BeBoB streams, Both of input and output CMP connection are important.
15eb7b3a05STakashi Sakamoto *
16eb7b3a05STakashi Sakamoto * For most devices, each CMP connection starts to transmit/receive a
17eb7b3a05STakashi Sakamoto * corresponding stream. But for a few devices, both of CMP connection needs
18eb7b3a05STakashi Sakamoto * to start transmitting stream. An example is 'M-Audio Firewire 410'.
19eb7b3a05STakashi Sakamoto */
20eb7b3a05STakashi Sakamoto
21eb7b3a05STakashi Sakamoto /* 128 is an arbitrary length but it seems to be enough */
22eb7b3a05STakashi Sakamoto #define FORMAT_MAXIMUM_LENGTH 128
23eb7b3a05STakashi Sakamoto
24eb7b3a05STakashi Sakamoto const unsigned int snd_bebob_rate_table[SND_BEBOB_STRM_FMT_ENTRIES] = {
25eb7b3a05STakashi Sakamoto [0] = 32000,
26eb7b3a05STakashi Sakamoto [1] = 44100,
27eb7b3a05STakashi Sakamoto [2] = 48000,
28eb7b3a05STakashi Sakamoto [3] = 88200,
29eb7b3a05STakashi Sakamoto [4] = 96000,
30eb7b3a05STakashi Sakamoto [5] = 176400,
31eb7b3a05STakashi Sakamoto [6] = 192000,
32eb7b3a05STakashi Sakamoto };
33eb7b3a05STakashi Sakamoto
34eb7b3a05STakashi Sakamoto /*
35eb7b3a05STakashi Sakamoto * See: Table 51: Extended Stream Format Info ‘Sampling Frequency’
36eb7b3a05STakashi Sakamoto * in Additional AVC commands (Nov 2003, BridgeCo)
37eb7b3a05STakashi Sakamoto */
38eb7b3a05STakashi Sakamoto static const unsigned int bridgeco_freq_table[] = {
39eb7b3a05STakashi Sakamoto [0] = 0x02,
40eb7b3a05STakashi Sakamoto [1] = 0x03,
41eb7b3a05STakashi Sakamoto [2] = 0x04,
42eb7b3a05STakashi Sakamoto [3] = 0x0a,
43eb7b3a05STakashi Sakamoto [4] = 0x05,
44eb7b3a05STakashi Sakamoto [5] = 0x06,
45eb7b3a05STakashi Sakamoto [6] = 0x07,
46eb7b3a05STakashi Sakamoto };
47eb7b3a05STakashi Sakamoto
4807905298SLucas Tanure static int
get_formation_index(unsigned int rate,unsigned int * index)4907905298SLucas Tanure get_formation_index(unsigned int rate, unsigned int *index)
50eb7b3a05STakashi Sakamoto {
51eb7b3a05STakashi Sakamoto unsigned int i;
52eb7b3a05STakashi Sakamoto
53eb7b3a05STakashi Sakamoto for (i = 0; i < ARRAY_SIZE(snd_bebob_rate_table); i++) {
5407905298SLucas Tanure if (snd_bebob_rate_table[i] == rate) {
5507905298SLucas Tanure *index = i;
5607905298SLucas Tanure return 0;
5707905298SLucas Tanure }
58eb7b3a05STakashi Sakamoto }
59eb7b3a05STakashi Sakamoto return -EINVAL;
60eb7b3a05STakashi Sakamoto }
61eb7b3a05STakashi Sakamoto
62eb7b3a05STakashi Sakamoto int
snd_bebob_stream_get_rate(struct snd_bebob * bebob,unsigned int * curr_rate)63eb7b3a05STakashi Sakamoto snd_bebob_stream_get_rate(struct snd_bebob *bebob, unsigned int *curr_rate)
64eb7b3a05STakashi Sakamoto {
65eb7b3a05STakashi Sakamoto unsigned int tx_rate, rx_rate, trials;
66eb7b3a05STakashi Sakamoto int err;
67eb7b3a05STakashi Sakamoto
68eb7b3a05STakashi Sakamoto trials = 0;
69eb7b3a05STakashi Sakamoto do {
70eb7b3a05STakashi Sakamoto err = avc_general_get_sig_fmt(bebob->unit, &tx_rate,
71eb7b3a05STakashi Sakamoto AVC_GENERAL_PLUG_DIR_OUT, 0);
72eb7b3a05STakashi Sakamoto } while (err == -EAGAIN && ++trials < 3);
73eb7b3a05STakashi Sakamoto if (err < 0)
74eb7b3a05STakashi Sakamoto goto end;
75eb7b3a05STakashi Sakamoto
76eb7b3a05STakashi Sakamoto trials = 0;
77eb7b3a05STakashi Sakamoto do {
78eb7b3a05STakashi Sakamoto err = avc_general_get_sig_fmt(bebob->unit, &rx_rate,
79eb7b3a05STakashi Sakamoto AVC_GENERAL_PLUG_DIR_IN, 0);
80eb7b3a05STakashi Sakamoto } while (err == -EAGAIN && ++trials < 3);
81eb7b3a05STakashi Sakamoto if (err < 0)
82eb7b3a05STakashi Sakamoto goto end;
83eb7b3a05STakashi Sakamoto
84eb7b3a05STakashi Sakamoto *curr_rate = rx_rate;
85eb7b3a05STakashi Sakamoto if (rx_rate == tx_rate)
86eb7b3a05STakashi Sakamoto goto end;
87eb7b3a05STakashi Sakamoto
88eb7b3a05STakashi Sakamoto /* synchronize receive stream rate to transmit stream rate */
89eb7b3a05STakashi Sakamoto err = avc_general_set_sig_fmt(bebob->unit, rx_rate,
90eb7b3a05STakashi Sakamoto AVC_GENERAL_PLUG_DIR_IN, 0);
91eb7b3a05STakashi Sakamoto end:
92eb7b3a05STakashi Sakamoto return err;
93eb7b3a05STakashi Sakamoto }
94eb7b3a05STakashi Sakamoto
95eb7b3a05STakashi Sakamoto int
snd_bebob_stream_set_rate(struct snd_bebob * bebob,unsigned int rate)96eb7b3a05STakashi Sakamoto snd_bebob_stream_set_rate(struct snd_bebob *bebob, unsigned int rate)
97eb7b3a05STakashi Sakamoto {
98eb7b3a05STakashi Sakamoto int err;
99eb7b3a05STakashi Sakamoto
100eb7b3a05STakashi Sakamoto err = avc_general_set_sig_fmt(bebob->unit, rate,
101eb7b3a05STakashi Sakamoto AVC_GENERAL_PLUG_DIR_OUT, 0);
102eb7b3a05STakashi Sakamoto if (err < 0)
103eb7b3a05STakashi Sakamoto goto end;
104eb7b3a05STakashi Sakamoto
105eb7b3a05STakashi Sakamoto err = avc_general_set_sig_fmt(bebob->unit, rate,
106eb7b3a05STakashi Sakamoto AVC_GENERAL_PLUG_DIR_IN, 0);
107eb7b3a05STakashi Sakamoto if (err < 0)
108eb7b3a05STakashi Sakamoto goto end;
109eb7b3a05STakashi Sakamoto
110eb7b3a05STakashi Sakamoto /*
111eb7b3a05STakashi Sakamoto * Some devices need a bit time for transition.
112eb7b3a05STakashi Sakamoto * 300msec is got by some experiments.
113eb7b3a05STakashi Sakamoto */
114eb7b3a05STakashi Sakamoto msleep(300);
115eb7b3a05STakashi Sakamoto end:
116eb7b3a05STakashi Sakamoto return err;
117eb7b3a05STakashi Sakamoto }
118eb7b3a05STakashi Sakamoto
snd_bebob_stream_get_clock_src(struct snd_bebob * bebob,enum snd_bebob_clock_type * src)1193e254b16STakashi Sakamoto int snd_bebob_stream_get_clock_src(struct snd_bebob *bebob,
1203e254b16STakashi Sakamoto enum snd_bebob_clock_type *src)
121eb7b3a05STakashi Sakamoto {
1226b9866c8SJulia Lawall const struct snd_bebob_clock_spec *clk_spec = bebob->spec->clock;
123eb7b3a05STakashi Sakamoto u8 addr[AVC_BRIDGECO_ADDR_BYTES], input[7];
1241fc9522aSTakashi Sakamoto unsigned int id;
1255a668812STakashi Sakamoto enum avc_bridgeco_plug_type type;
126eb7b3a05STakashi Sakamoto int err = 0;
127eb7b3a05STakashi Sakamoto
1281fc9522aSTakashi Sakamoto /* 1.The device has its own operation to switch source of clock */
1291fc9522aSTakashi Sakamoto if (clk_spec) {
1301fc9522aSTakashi Sakamoto err = clk_spec->get(bebob, &id);
131d1d0b6b6SChristian Vogel if (err < 0) {
1321fc9522aSTakashi Sakamoto dev_err(&bebob->unit->device,
1331fc9522aSTakashi Sakamoto "fail to get clock source: %d\n", err);
134d1d0b6b6SChristian Vogel goto end;
135d1d0b6b6SChristian Vogel }
136d1d0b6b6SChristian Vogel
137d1d0b6b6SChristian Vogel if (id >= clk_spec->num) {
138d1d0b6b6SChristian Vogel dev_err(&bebob->unit->device,
139d1d0b6b6SChristian Vogel "clock source %d out of range 0..%d\n",
140d1d0b6b6SChristian Vogel id, clk_spec->num - 1);
141d1d0b6b6SChristian Vogel err = -EIO;
142d1d0b6b6SChristian Vogel goto end;
143d1d0b6b6SChristian Vogel }
144d1d0b6b6SChristian Vogel
1453e254b16STakashi Sakamoto *src = clk_spec->types[id];
1461fc9522aSTakashi Sakamoto goto end;
1471fc9522aSTakashi Sakamoto }
1481fc9522aSTakashi Sakamoto
149eb7b3a05STakashi Sakamoto /*
1501fc9522aSTakashi Sakamoto * 2.The device don't support to switch source of clock then assumed
151eb7b3a05STakashi Sakamoto * to use internal clock always
152eb7b3a05STakashi Sakamoto */
153eb7b3a05STakashi Sakamoto if (bebob->sync_input_plug < 0) {
1543e254b16STakashi Sakamoto *src = SND_BEBOB_CLOCK_TYPE_INTERNAL;
155eb7b3a05STakashi Sakamoto goto end;
156eb7b3a05STakashi Sakamoto }
157eb7b3a05STakashi Sakamoto
158eb7b3a05STakashi Sakamoto /*
1591fc9522aSTakashi Sakamoto * 3.The device supports to switch source of clock by an usual way.
160eb7b3a05STakashi Sakamoto * Let's check input for 'Music Sub Unit Sync Input' plug.
161eb7b3a05STakashi Sakamoto */
162eb7b3a05STakashi Sakamoto avc_bridgeco_fill_msu_addr(addr, AVC_BRIDGECO_PLUG_DIR_IN,
163eb7b3a05STakashi Sakamoto bebob->sync_input_plug);
164eb7b3a05STakashi Sakamoto err = avc_bridgeco_get_plug_input(bebob->unit, addr, input);
165eb7b3a05STakashi Sakamoto if (err < 0) {
166eb7b3a05STakashi Sakamoto dev_err(&bebob->unit->device,
167eb7b3a05STakashi Sakamoto "fail to get an input for MSU in plug %d: %d\n",
168eb7b3a05STakashi Sakamoto bebob->sync_input_plug, err);
169eb7b3a05STakashi Sakamoto goto end;
170eb7b3a05STakashi Sakamoto }
171eb7b3a05STakashi Sakamoto
172eb7b3a05STakashi Sakamoto /*
173eb7b3a05STakashi Sakamoto * If there are no input plugs, all of fields are 0xff.
174eb7b3a05STakashi Sakamoto * Here check the first field. This field is used for direction.
175eb7b3a05STakashi Sakamoto */
176eb7b3a05STakashi Sakamoto if (input[0] == 0xff) {
1773e254b16STakashi Sakamoto *src = SND_BEBOB_CLOCK_TYPE_INTERNAL;
178eb7b3a05STakashi Sakamoto goto end;
179eb7b3a05STakashi Sakamoto }
180eb7b3a05STakashi Sakamoto
1815a668812STakashi Sakamoto /* The source from any output plugs is for one purpose only. */
1825a668812STakashi Sakamoto if (input[0] == AVC_BRIDGECO_PLUG_DIR_OUT) {
183eb7b3a05STakashi Sakamoto /*
1845a668812STakashi Sakamoto * In BeBoB architecture, the source from music subunit may
1855a668812STakashi Sakamoto * bypass from oPCR[0]. This means that this source gives
1865a668812STakashi Sakamoto * synchronization to IEEE 1394 cycle start packet.
187eb7b3a05STakashi Sakamoto */
1885a668812STakashi Sakamoto if (input[1] == AVC_BRIDGECO_PLUG_MODE_SUBUNIT &&
1895a668812STakashi Sakamoto input[2] == 0x0c) {
1903e254b16STakashi Sakamoto *src = SND_BEBOB_CLOCK_TYPE_INTERNAL;
1915a668812STakashi Sakamoto goto end;
1925a668812STakashi Sakamoto }
1935a668812STakashi Sakamoto /* The source from any input units is for several purposes. */
1945a668812STakashi Sakamoto } else if (input[1] == AVC_BRIDGECO_PLUG_MODE_UNIT) {
1955a668812STakashi Sakamoto if (input[2] == AVC_BRIDGECO_PLUG_UNIT_ISOC) {
1965a668812STakashi Sakamoto if (input[3] == 0x00) {
1975a668812STakashi Sakamoto /*
1985a668812STakashi Sakamoto * This source comes from iPCR[0]. This means
1995a668812STakashi Sakamoto * that presentation timestamp calculated by
2005a668812STakashi Sakamoto * SYT series of the received packets. In
2015a668812STakashi Sakamoto * short, this driver is the master of
2025a668812STakashi Sakamoto * synchronization.
2035a668812STakashi Sakamoto */
2043e254b16STakashi Sakamoto *src = SND_BEBOB_CLOCK_TYPE_SYT;
2055a668812STakashi Sakamoto goto end;
2065a668812STakashi Sakamoto } else {
2075a668812STakashi Sakamoto /*
2085a668812STakashi Sakamoto * This source comes from iPCR[1-29]. This
2095a668812STakashi Sakamoto * means that the synchronization stream is not
2105a668812STakashi Sakamoto * the Audio/MIDI compound stream.
2115a668812STakashi Sakamoto */
2123e254b16STakashi Sakamoto *src = SND_BEBOB_CLOCK_TYPE_EXTERNAL;
2135a668812STakashi Sakamoto goto end;
2145a668812STakashi Sakamoto }
2155a668812STakashi Sakamoto } else if (input[2] == AVC_BRIDGECO_PLUG_UNIT_EXT) {
2165a668812STakashi Sakamoto /* Check type of this plug. */
2175a668812STakashi Sakamoto avc_bridgeco_fill_unit_addr(addr,
2185a668812STakashi Sakamoto AVC_BRIDGECO_PLUG_DIR_IN,
2195a668812STakashi Sakamoto AVC_BRIDGECO_PLUG_UNIT_EXT,
2205a668812STakashi Sakamoto input[3]);
2215a668812STakashi Sakamoto err = avc_bridgeco_get_plug_type(bebob->unit, addr,
2225a668812STakashi Sakamoto &type);
2235a668812STakashi Sakamoto if (err < 0)
2245a668812STakashi Sakamoto goto end;
2255a668812STakashi Sakamoto
2265a668812STakashi Sakamoto if (type == AVC_BRIDGECO_PLUG_TYPE_DIG) {
2275a668812STakashi Sakamoto /*
2285a668812STakashi Sakamoto * SPDIF/ADAT or sometimes (not always) word
2295a668812STakashi Sakamoto * clock.
2305a668812STakashi Sakamoto */
2313e254b16STakashi Sakamoto *src = SND_BEBOB_CLOCK_TYPE_EXTERNAL;
2325a668812STakashi Sakamoto goto end;
2335a668812STakashi Sakamoto } else if (type == AVC_BRIDGECO_PLUG_TYPE_SYNC) {
2345a668812STakashi Sakamoto /* Often word clock. */
2353e254b16STakashi Sakamoto *src = SND_BEBOB_CLOCK_TYPE_EXTERNAL;
2365a668812STakashi Sakamoto goto end;
2375a668812STakashi Sakamoto } else if (type == AVC_BRIDGECO_PLUG_TYPE_ADDITION) {
2385a668812STakashi Sakamoto /*
2395a668812STakashi Sakamoto * Not standard.
2405a668812STakashi Sakamoto * Mostly, additional internal clock.
2415a668812STakashi Sakamoto */
2423e254b16STakashi Sakamoto *src = SND_BEBOB_CLOCK_TYPE_INTERNAL;
2435a668812STakashi Sakamoto goto end;
2445a668812STakashi Sakamoto }
2455a668812STakashi Sakamoto }
2465a668812STakashi Sakamoto }
2475a668812STakashi Sakamoto
2485a668812STakashi Sakamoto /* Not supported. */
2495a668812STakashi Sakamoto err = -EIO;
250eb7b3a05STakashi Sakamoto end:
251eb7b3a05STakashi Sakamoto return err;
252eb7b3a05STakashi Sakamoto }
253eb7b3a05STakashi Sakamoto
map_data_channels(struct snd_bebob * bebob,struct amdtp_stream * s)254f2bbdbcbSTakashi Sakamoto static int map_data_channels(struct snd_bebob *bebob, struct amdtp_stream *s)
255eb7b3a05STakashi Sakamoto {
256eb7b3a05STakashi Sakamoto unsigned int sec, sections, ch, channels;
257eb7b3a05STakashi Sakamoto unsigned int pcm, midi, location;
258eb7b3a05STakashi Sakamoto unsigned int stm_pos, sec_loc, pos;
259eb7b3a05STakashi Sakamoto u8 *buf, addr[AVC_BRIDGECO_ADDR_BYTES], type;
260eb7b3a05STakashi Sakamoto enum avc_bridgeco_plug_dir dir;
261eb7b3a05STakashi Sakamoto int err;
262eb7b3a05STakashi Sakamoto
263eb7b3a05STakashi Sakamoto /*
264eb7b3a05STakashi Sakamoto * The length of return value of this command cannot be expected. Here
265eb7b3a05STakashi Sakamoto * use the maximum length of FCP.
266eb7b3a05STakashi Sakamoto */
267eb7b3a05STakashi Sakamoto buf = kzalloc(256, GFP_KERNEL);
268eb7b3a05STakashi Sakamoto if (buf == NULL)
269eb7b3a05STakashi Sakamoto return -ENOMEM;
270eb7b3a05STakashi Sakamoto
271eb7b3a05STakashi Sakamoto if (s == &bebob->tx_stream)
272eb7b3a05STakashi Sakamoto dir = AVC_BRIDGECO_PLUG_DIR_OUT;
273eb7b3a05STakashi Sakamoto else
274eb7b3a05STakashi Sakamoto dir = AVC_BRIDGECO_PLUG_DIR_IN;
275eb7b3a05STakashi Sakamoto
276eb7b3a05STakashi Sakamoto avc_bridgeco_fill_unit_addr(addr, dir, AVC_BRIDGECO_PLUG_UNIT_ISOC, 0);
277eb7b3a05STakashi Sakamoto err = avc_bridgeco_get_plug_ch_pos(bebob->unit, addr, buf, 256);
278eb7b3a05STakashi Sakamoto if (err < 0) {
279eb7b3a05STakashi Sakamoto dev_err(&bebob->unit->device,
280eb7b3a05STakashi Sakamoto "fail to get channel position for isoc %s plug 0: %d\n",
281eb7b3a05STakashi Sakamoto (dir == AVC_BRIDGECO_PLUG_DIR_IN) ? "in" : "out",
282eb7b3a05STakashi Sakamoto err);
283eb7b3a05STakashi Sakamoto goto end;
284eb7b3a05STakashi Sakamoto }
285eb7b3a05STakashi Sakamoto pos = 0;
286eb7b3a05STakashi Sakamoto
287eb7b3a05STakashi Sakamoto /* positions in I/O buffer */
288eb7b3a05STakashi Sakamoto pcm = 0;
289eb7b3a05STakashi Sakamoto midi = 0;
290eb7b3a05STakashi Sakamoto
291eb7b3a05STakashi Sakamoto /* the number of sections in AMDTP packet */
292eb7b3a05STakashi Sakamoto sections = buf[pos++];
293eb7b3a05STakashi Sakamoto
294eb7b3a05STakashi Sakamoto for (sec = 0; sec < sections; sec++) {
295eb7b3a05STakashi Sakamoto /* type of this section */
296eb7b3a05STakashi Sakamoto avc_bridgeco_fill_unit_addr(addr, dir,
297eb7b3a05STakashi Sakamoto AVC_BRIDGECO_PLUG_UNIT_ISOC, 0);
298eb7b3a05STakashi Sakamoto err = avc_bridgeco_get_plug_section_type(bebob->unit, addr,
299eb7b3a05STakashi Sakamoto sec, &type);
300eb7b3a05STakashi Sakamoto if (err < 0) {
301eb7b3a05STakashi Sakamoto dev_err(&bebob->unit->device,
302eb7b3a05STakashi Sakamoto "fail to get section type for isoc %s plug 0: %d\n",
303eb7b3a05STakashi Sakamoto (dir == AVC_BRIDGECO_PLUG_DIR_IN) ? "in" :
304eb7b3a05STakashi Sakamoto "out",
305eb7b3a05STakashi Sakamoto err);
306eb7b3a05STakashi Sakamoto goto end;
307eb7b3a05STakashi Sakamoto }
308eb7b3a05STakashi Sakamoto /* NoType */
309eb7b3a05STakashi Sakamoto if (type == 0xff) {
310eb7b3a05STakashi Sakamoto err = -ENOSYS;
311eb7b3a05STakashi Sakamoto goto end;
312eb7b3a05STakashi Sakamoto }
313eb7b3a05STakashi Sakamoto
314eb7b3a05STakashi Sakamoto /* the number of channels in this section */
315eb7b3a05STakashi Sakamoto channels = buf[pos++];
316eb7b3a05STakashi Sakamoto
317eb7b3a05STakashi Sakamoto for (ch = 0; ch < channels; ch++) {
318eb7b3a05STakashi Sakamoto /* position of this channel in AMDTP packet */
319eb7b3a05STakashi Sakamoto stm_pos = buf[pos++] - 1;
320eb7b3a05STakashi Sakamoto /* location of this channel in this section */
321eb7b3a05STakashi Sakamoto sec_loc = buf[pos++] - 1;
322eb7b3a05STakashi Sakamoto
3239076c22dSTakashi Sakamoto /*
3249076c22dSTakashi Sakamoto * Basically the number of location is within the
3259076c22dSTakashi Sakamoto * number of channels in this section. But some models
3269076c22dSTakashi Sakamoto * of M-Audio don't follow this. Its location for MIDI
3279076c22dSTakashi Sakamoto * is the position of MIDI channels in AMDTP packet.
3289076c22dSTakashi Sakamoto */
3299076c22dSTakashi Sakamoto if (sec_loc >= channels)
3309076c22dSTakashi Sakamoto sec_loc = ch;
3319076c22dSTakashi Sakamoto
332eb7b3a05STakashi Sakamoto switch (type) {
333eb7b3a05STakashi Sakamoto /* for MIDI conformant data channel */
334eb7b3a05STakashi Sakamoto case 0x0a:
335eb7b3a05STakashi Sakamoto /* AMDTP_MAX_CHANNELS_FOR_MIDI is 1. */
336eb7b3a05STakashi Sakamoto if ((midi > 0) && (stm_pos != midi)) {
337eb7b3a05STakashi Sakamoto err = -ENOSYS;
338eb7b3a05STakashi Sakamoto goto end;
339eb7b3a05STakashi Sakamoto }
340f65be911STakashi Sakamoto amdtp_am824_set_midi_position(s, stm_pos);
341eb7b3a05STakashi Sakamoto midi = stm_pos;
342eb7b3a05STakashi Sakamoto break;
343eb7b3a05STakashi Sakamoto /* for PCM data channel */
344eb7b3a05STakashi Sakamoto case 0x01: /* Headphone */
345eb7b3a05STakashi Sakamoto case 0x02: /* Microphone */
346eb7b3a05STakashi Sakamoto case 0x03: /* Line */
347eb7b3a05STakashi Sakamoto case 0x04: /* SPDIF */
348eb7b3a05STakashi Sakamoto case 0x05: /* ADAT */
349eb7b3a05STakashi Sakamoto case 0x06: /* TDIF */
350eb7b3a05STakashi Sakamoto case 0x07: /* MADI */
351eb7b3a05STakashi Sakamoto /* for undefined/changeable signal */
352eb7b3a05STakashi Sakamoto case 0x08: /* Analog */
353eb7b3a05STakashi Sakamoto case 0x09: /* Digital */
354eb7b3a05STakashi Sakamoto default:
355eb7b3a05STakashi Sakamoto location = pcm + sec_loc;
35649c7b3fcSTakashi Sakamoto if (location >= AM824_MAX_CHANNELS_FOR_PCM) {
357eb7b3a05STakashi Sakamoto err = -ENOSYS;
358eb7b3a05STakashi Sakamoto goto end;
359eb7b3a05STakashi Sakamoto }
360f65be911STakashi Sakamoto amdtp_am824_set_pcm_position(s, location,
361f65be911STakashi Sakamoto stm_pos);
362eb7b3a05STakashi Sakamoto break;
363eb7b3a05STakashi Sakamoto }
364eb7b3a05STakashi Sakamoto }
365eb7b3a05STakashi Sakamoto
366eb7b3a05STakashi Sakamoto if (type != 0x0a)
367eb7b3a05STakashi Sakamoto pcm += channels;
368eb7b3a05STakashi Sakamoto else
369eb7b3a05STakashi Sakamoto midi += channels;
370eb7b3a05STakashi Sakamoto }
371eb7b3a05STakashi Sakamoto end:
372eb7b3a05STakashi Sakamoto kfree(buf);
373eb7b3a05STakashi Sakamoto return err;
374eb7b3a05STakashi Sakamoto }
375eb7b3a05STakashi Sakamoto
376eb7b3a05STakashi Sakamoto static int
check_connection_used_by_others(struct snd_bebob * bebob,struct amdtp_stream * s)377eb7b3a05STakashi Sakamoto check_connection_used_by_others(struct snd_bebob *bebob, struct amdtp_stream *s)
378eb7b3a05STakashi Sakamoto {
379eb7b3a05STakashi Sakamoto struct cmp_connection *conn;
380eb7b3a05STakashi Sakamoto bool used;
381eb7b3a05STakashi Sakamoto int err;
382eb7b3a05STakashi Sakamoto
383eb7b3a05STakashi Sakamoto if (s == &bebob->tx_stream)
384eb7b3a05STakashi Sakamoto conn = &bebob->out_conn;
385eb7b3a05STakashi Sakamoto else
386eb7b3a05STakashi Sakamoto conn = &bebob->in_conn;
387eb7b3a05STakashi Sakamoto
388eb7b3a05STakashi Sakamoto err = cmp_connection_check_used(conn, &used);
389eb7b3a05STakashi Sakamoto if ((err >= 0) && used && !amdtp_stream_running(s)) {
390eb7b3a05STakashi Sakamoto dev_err(&bebob->unit->device,
391eb7b3a05STakashi Sakamoto "Connection established by others: %cPCR[%d]\n",
392eb7b3a05STakashi Sakamoto (conn->direction == CMP_OUTPUT) ? 'o' : 'i',
393eb7b3a05STakashi Sakamoto conn->pcr_index);
394eb7b3a05STakashi Sakamoto err = -EBUSY;
395eb7b3a05STakashi Sakamoto }
396eb7b3a05STakashi Sakamoto
397eb7b3a05STakashi Sakamoto return err;
398eb7b3a05STakashi Sakamoto }
399eb7b3a05STakashi Sakamoto
break_both_connections(struct snd_bebob * bebob)400d3eabe93STakashi Sakamoto static void break_both_connections(struct snd_bebob *bebob)
401eb7b3a05STakashi Sakamoto {
402eb7b3a05STakashi Sakamoto cmp_connection_break(&bebob->in_conn);
403eb7b3a05STakashi Sakamoto cmp_connection_break(&bebob->out_conn);
404eb7b3a05STakashi Sakamoto }
405eb7b3a05STakashi Sakamoto
start_stream(struct snd_bebob * bebob,struct amdtp_stream * stream)4066c94f380STakashi Sakamoto static int start_stream(struct snd_bebob *bebob, struct amdtp_stream *stream)
407eb7b3a05STakashi Sakamoto {
408eb7b3a05STakashi Sakamoto struct cmp_connection *conn;
409eb7b3a05STakashi Sakamoto int err = 0;
410eb7b3a05STakashi Sakamoto
411eb7b3a05STakashi Sakamoto if (stream == &bebob->rx_stream)
412eb7b3a05STakashi Sakamoto conn = &bebob->in_conn;
413eb7b3a05STakashi Sakamoto else
414eb7b3a05STakashi Sakamoto conn = &bebob->out_conn;
415eb7b3a05STakashi Sakamoto
4166c94f380STakashi Sakamoto // channel mapping.
4173149ac48STakashi Sakamoto if (bebob->maudio_special_quirk == NULL) {
418eb7b3a05STakashi Sakamoto err = map_data_channels(bebob, stream);
419eb7b3a05STakashi Sakamoto if (err < 0)
4206c94f380STakashi Sakamoto return err;
4213149ac48STakashi Sakamoto }
422eb7b3a05STakashi Sakamoto
4236c94f380STakashi Sakamoto err = cmp_connection_establish(conn);
4246c94f380STakashi Sakamoto if (err < 0)
425eb7b3a05STakashi Sakamoto return err;
4266c94f380STakashi Sakamoto
4276c94f380STakashi Sakamoto return amdtp_domain_add_stream(&bebob->domain, stream,
4286c94f380STakashi Sakamoto conn->resources.channel, conn->speed);
429eb7b3a05STakashi Sakamoto }
430eb7b3a05STakashi Sakamoto
init_stream(struct snd_bebob * bebob,struct amdtp_stream * stream)43133e41a5cSTakashi Sakamoto static int init_stream(struct snd_bebob *bebob, struct amdtp_stream *stream)
432eb7b3a05STakashi Sakamoto {
43393cd12d6STakashi Sakamoto unsigned int flags = CIP_BLOCKING;
43433e41a5cSTakashi Sakamoto enum amdtp_stream_direction dir_stream;
43533e41a5cSTakashi Sakamoto struct cmp_connection *conn;
43633e41a5cSTakashi Sakamoto enum cmp_direction dir_conn;
437eb7b3a05STakashi Sakamoto int err;
438eb7b3a05STakashi Sakamoto
43933e41a5cSTakashi Sakamoto if (stream == &bebob->tx_stream) {
44033e41a5cSTakashi Sakamoto dir_stream = AMDTP_IN_STREAM;
44133e41a5cSTakashi Sakamoto conn = &bebob->out_conn;
44233e41a5cSTakashi Sakamoto dir_conn = CMP_OUTPUT;
44333e41a5cSTakashi Sakamoto } else {
44433e41a5cSTakashi Sakamoto dir_stream = AMDTP_OUT_STREAM;
44533e41a5cSTakashi Sakamoto conn = &bebob->in_conn;
44633e41a5cSTakashi Sakamoto dir_conn = CMP_INPUT;
447eb7b3a05STakashi Sakamoto }
44814a37ac1STakashi Sakamoto
44993cd12d6STakashi Sakamoto if (stream == &bebob->tx_stream) {
45093cd12d6STakashi Sakamoto if (bebob->quirks & SND_BEBOB_QUIRK_WRONG_DBC)
45193cd12d6STakashi Sakamoto flags |= CIP_EMPTY_HAS_WRONG_DBC;
45293cd12d6STakashi Sakamoto }
45393cd12d6STakashi Sakamoto
45433e41a5cSTakashi Sakamoto err = cmp_connection_init(conn, bebob->unit, dir_conn, 0);
45533e41a5cSTakashi Sakamoto if (err < 0)
45633e41a5cSTakashi Sakamoto return err;
45733e41a5cSTakashi Sakamoto
45893cd12d6STakashi Sakamoto err = amdtp_am824_init(stream, bebob->unit, dir_stream, flags);
45933e41a5cSTakashi Sakamoto if (err < 0) {
46033e41a5cSTakashi Sakamoto cmp_connection_destroy(conn);
46133e41a5cSTakashi Sakamoto return err;
46233e41a5cSTakashi Sakamoto }
46333e41a5cSTakashi Sakamoto
46433e41a5cSTakashi Sakamoto return 0;
46533e41a5cSTakashi Sakamoto }
46633e41a5cSTakashi Sakamoto
destroy_stream(struct snd_bebob * bebob,struct amdtp_stream * stream)46733e41a5cSTakashi Sakamoto static void destroy_stream(struct snd_bebob *bebob, struct amdtp_stream *stream)
46833e41a5cSTakashi Sakamoto {
46933e41a5cSTakashi Sakamoto amdtp_stream_destroy(stream);
47033e41a5cSTakashi Sakamoto
47133e41a5cSTakashi Sakamoto if (stream == &bebob->tx_stream)
47233e41a5cSTakashi Sakamoto cmp_connection_destroy(&bebob->out_conn);
47333e41a5cSTakashi Sakamoto else
47433e41a5cSTakashi Sakamoto cmp_connection_destroy(&bebob->in_conn);
47533e41a5cSTakashi Sakamoto }
47633e41a5cSTakashi Sakamoto
snd_bebob_stream_init_duplex(struct snd_bebob * bebob)47733e41a5cSTakashi Sakamoto int snd_bebob_stream_init_duplex(struct snd_bebob *bebob)
47833e41a5cSTakashi Sakamoto {
47933e41a5cSTakashi Sakamoto int err;
48033e41a5cSTakashi Sakamoto
48133e41a5cSTakashi Sakamoto err = init_stream(bebob, &bebob->tx_stream);
48233e41a5cSTakashi Sakamoto if (err < 0)
483eb7b3a05STakashi Sakamoto return err;
48433e41a5cSTakashi Sakamoto
48533e41a5cSTakashi Sakamoto err = init_stream(bebob, &bebob->rx_stream);
48633e41a5cSTakashi Sakamoto if (err < 0) {
48733e41a5cSTakashi Sakamoto destroy_stream(bebob, &bebob->tx_stream);
48833e41a5cSTakashi Sakamoto return err;
48933e41a5cSTakashi Sakamoto }
49033e41a5cSTakashi Sakamoto
491b0db4d51STakashi Sakamoto err = amdtp_domain_init(&bebob->domain);
492b0db4d51STakashi Sakamoto if (err < 0) {
493b0db4d51STakashi Sakamoto destroy_stream(bebob, &bebob->tx_stream);
494b0db4d51STakashi Sakamoto destroy_stream(bebob, &bebob->rx_stream);
495b0db4d51STakashi Sakamoto }
496b0db4d51STakashi Sakamoto
497b0db4d51STakashi Sakamoto return err;
498eb7b3a05STakashi Sakamoto }
499eb7b3a05STakashi Sakamoto
keep_resources(struct snd_bebob * bebob,struct amdtp_stream * stream,unsigned int rate,unsigned int index)500ac2888b9STakashi Sakamoto static int keep_resources(struct snd_bebob *bebob, struct amdtp_stream *stream,
501ac2888b9STakashi Sakamoto unsigned int rate, unsigned int index)
502eb7b3a05STakashi Sakamoto {
503d2b6f15bSTakashi Sakamoto unsigned int pcm_channels;
504d2b6f15bSTakashi Sakamoto unsigned int midi_ports;
5057bc93821STakashi Sakamoto struct cmp_connection *conn;
5067bc93821STakashi Sakamoto int err;
507ac2888b9STakashi Sakamoto
5087bc93821STakashi Sakamoto if (stream == &bebob->tx_stream) {
509d2b6f15bSTakashi Sakamoto pcm_channels = bebob->tx_stream_formations[index].pcm;
510d2b6f15bSTakashi Sakamoto midi_ports = bebob->midi_input_ports;
5117bc93821STakashi Sakamoto conn = &bebob->out_conn;
5127bc93821STakashi Sakamoto } else {
513d2b6f15bSTakashi Sakamoto pcm_channels = bebob->rx_stream_formations[index].pcm;
514d2b6f15bSTakashi Sakamoto midi_ports = bebob->midi_output_ports;
5157bc93821STakashi Sakamoto conn = &bebob->in_conn;
5167bc93821STakashi Sakamoto }
517ac2888b9STakashi Sakamoto
518d2b6f15bSTakashi Sakamoto err = amdtp_am824_set_parameters(stream, rate, pcm_channels, midi_ports, false);
5197bc93821STakashi Sakamoto if (err < 0)
5207bc93821STakashi Sakamoto return err;
5217bc93821STakashi Sakamoto
5227bc93821STakashi Sakamoto return cmp_connection_reserve(conn, amdtp_stream_get_max_payload(stream));
523ac2888b9STakashi Sakamoto }
524ac2888b9STakashi Sakamoto
snd_bebob_stream_reserve_duplex(struct snd_bebob * bebob,unsigned int rate,unsigned int frames_per_period,unsigned int frames_per_buffer)5258737209fSTakashi Sakamoto int snd_bebob_stream_reserve_duplex(struct snd_bebob *bebob, unsigned int rate,
5261fde7a44STakashi Sakamoto unsigned int frames_per_period,
5271fde7a44STakashi Sakamoto unsigned int frames_per_buffer)
528ac2888b9STakashi Sakamoto {
529eb7b3a05STakashi Sakamoto unsigned int curr_rate;
530ac2888b9STakashi Sakamoto int err;
531eb7b3a05STakashi Sakamoto
532ac2888b9STakashi Sakamoto // Considering JACK/FFADO streaming:
533ac2888b9STakashi Sakamoto // TODO: This can be removed hwdep functionality becomes popular.
534c71283cbSTakashi Sakamoto err = check_connection_used_by_others(bebob, &bebob->rx_stream);
535eb7b3a05STakashi Sakamoto if (err < 0)
536ac2888b9STakashi Sakamoto return err;
537eb7b3a05STakashi Sakamoto
538ac2888b9STakashi Sakamoto err = bebob->spec->rate->get(bebob, &curr_rate);
539ac2888b9STakashi Sakamoto if (err < 0)
540ac2888b9STakashi Sakamoto return err;
541eb7b3a05STakashi Sakamoto if (rate == 0)
542eb7b3a05STakashi Sakamoto rate = curr_rate;
543ac2888b9STakashi Sakamoto if (curr_rate != rate) {
544b0db4d51STakashi Sakamoto amdtp_domain_stop(&bebob->domain);
545eb7b3a05STakashi Sakamoto break_both_connections(bebob);
5467599e279STakashi Sakamoto
5477599e279STakashi Sakamoto cmp_connection_release(&bebob->out_conn);
5487599e279STakashi Sakamoto cmp_connection_release(&bebob->in_conn);
549eb7b3a05STakashi Sakamoto }
550eb7b3a05STakashi Sakamoto
551ac2888b9STakashi Sakamoto if (bebob->substreams_counter == 0 || curr_rate != rate) {
552ac2888b9STakashi Sakamoto unsigned int index;
553ac2888b9STakashi Sakamoto
554ac2888b9STakashi Sakamoto // NOTE:
555ac2888b9STakashi Sakamoto // If establishing connections at first, Yamaha GO46
556ac2888b9STakashi Sakamoto // (and maybe Terratec X24) don't generate sound.
557ac2888b9STakashi Sakamoto //
558ac2888b9STakashi Sakamoto // For firmware customized by M-Audio, refer to next NOTE.
559ac2888b9STakashi Sakamoto err = bebob->spec->rate->set(bebob, rate);
560eb7b3a05STakashi Sakamoto if (err < 0) {
561eb7b3a05STakashi Sakamoto dev_err(&bebob->unit->device,
562eb7b3a05STakashi Sakamoto "fail to set sampling rate: %d\n",
563eb7b3a05STakashi Sakamoto err);
564ac2888b9STakashi Sakamoto return err;
5653149ac48STakashi Sakamoto }
566eb7b3a05STakashi Sakamoto
567ac2888b9STakashi Sakamoto err = get_formation_index(rate, &index);
568eb7b3a05STakashi Sakamoto if (err < 0)
569ac2888b9STakashi Sakamoto return err;
570eb7b3a05STakashi Sakamoto
571ac2888b9STakashi Sakamoto err = keep_resources(bebob, &bebob->tx_stream, rate, index);
572ac2888b9STakashi Sakamoto if (err < 0)
573ac2888b9STakashi Sakamoto return err;
574ac2888b9STakashi Sakamoto
575ac2888b9STakashi Sakamoto err = keep_resources(bebob, &bebob->rx_stream, rate, index);
5767bc93821STakashi Sakamoto if (err < 0) {
5777bc93821STakashi Sakamoto cmp_connection_release(&bebob->out_conn);
578ac2888b9STakashi Sakamoto return err;
579ac2888b9STakashi Sakamoto }
5808737209fSTakashi Sakamoto
5818737209fSTakashi Sakamoto err = amdtp_domain_set_events_per_period(&bebob->domain,
5821fde7a44STakashi Sakamoto frames_per_period, frames_per_buffer);
5838737209fSTakashi Sakamoto if (err < 0) {
5848737209fSTakashi Sakamoto cmp_connection_release(&bebob->out_conn);
5858737209fSTakashi Sakamoto cmp_connection_release(&bebob->in_conn);
5868737209fSTakashi Sakamoto return err;
5878737209fSTakashi Sakamoto }
5887bc93821STakashi Sakamoto }
589ac2888b9STakashi Sakamoto
590ac2888b9STakashi Sakamoto return 0;
591ac2888b9STakashi Sakamoto }
592ac2888b9STakashi Sakamoto
snd_bebob_stream_start_duplex(struct snd_bebob * bebob)593ac2888b9STakashi Sakamoto int snd_bebob_stream_start_duplex(struct snd_bebob *bebob)
594ac2888b9STakashi Sakamoto {
595ac2888b9STakashi Sakamoto int err;
596ac2888b9STakashi Sakamoto
597ac2888b9STakashi Sakamoto // Need no substreams.
598ac2888b9STakashi Sakamoto if (bebob->substreams_counter == 0)
599ac2888b9STakashi Sakamoto return -EIO;
600ac2888b9STakashi Sakamoto
601ac2888b9STakashi Sakamoto // packet queueing error or detecting discontinuity
602ac2888b9STakashi Sakamoto if (amdtp_streaming_error(&bebob->rx_stream) ||
603ac2888b9STakashi Sakamoto amdtp_streaming_error(&bebob->tx_stream)) {
604b0db4d51STakashi Sakamoto amdtp_domain_stop(&bebob->domain);
605ac2888b9STakashi Sakamoto break_both_connections(bebob);
606ac2888b9STakashi Sakamoto }
607ac2888b9STakashi Sakamoto
608ac2888b9STakashi Sakamoto if (!amdtp_stream_running(&bebob->rx_stream)) {
6096c94f380STakashi Sakamoto enum snd_bebob_clock_type src;
610ac2888b9STakashi Sakamoto unsigned int curr_rate;
61126541cb1STakashi Sakamoto unsigned int tx_init_skip_cycles;
612ac2888b9STakashi Sakamoto
613ac2888b9STakashi Sakamoto if (bebob->maudio_special_quirk) {
614ac2888b9STakashi Sakamoto err = bebob->spec->rate->get(bebob, &curr_rate);
615ac2888b9STakashi Sakamoto if (err < 0)
616ac2888b9STakashi Sakamoto return err;
617ac2888b9STakashi Sakamoto }
618ac2888b9STakashi Sakamoto
6196c94f380STakashi Sakamoto err = snd_bebob_stream_get_clock_src(bebob, &src);
620ac2888b9STakashi Sakamoto if (err < 0)
621ac2888b9STakashi Sakamoto return err;
622ac2888b9STakashi Sakamoto
623266807f9STakashi Sakamoto err = start_stream(bebob, &bebob->rx_stream);
624b0db4d51STakashi Sakamoto if (err < 0)
625ac2888b9STakashi Sakamoto goto error;
626b0db4d51STakashi Sakamoto
627266807f9STakashi Sakamoto err = start_stream(bebob, &bebob->tx_stream);
628b0db4d51STakashi Sakamoto if (err < 0)
629b0db4d51STakashi Sakamoto goto error;
630b0db4d51STakashi Sakamoto
63193cd12d6STakashi Sakamoto if (!(bebob->quirks & SND_BEBOB_QUIRK_INITIAL_DISCONTINUOUS_DBC))
6325ec85c19STakashi Sakamoto tx_init_skip_cycles = 0;
633da5e8337STakashi Sakamoto else
63426541cb1STakashi Sakamoto tx_init_skip_cycles = 16000;
6355ec85c19STakashi Sakamoto
6361bd1b3beSTakashi Sakamoto // MEMO: Some devices start packet transmission long enough after establishment of
6371bd1b3beSTakashi Sakamoto // CMP connection. In the early stage of packet streaming, any device transfers
6381bd1b3beSTakashi Sakamoto // NODATA packets. After several hundred cycles, it begins to multiplex event into
6391bd1b3beSTakashi Sakamoto // the packet with adequate value of syt field in CIP header. Some devices are
6401bd1b3beSTakashi Sakamoto // strictly to generate any discontinuity in the sequence of tx packet when they
6411bd1b3beSTakashi Sakamoto // receives inadequate sequence of value in syt field of CIP header. In the case,
6421bd1b3beSTakashi Sakamoto // the request to break CMP connection is often corrupted, then any transaction
6431bd1b3beSTakashi Sakamoto // results in unrecoverable error, sometimes generate bus-reset.
6441bd1b3beSTakashi Sakamoto err = amdtp_domain_start(&bebob->domain, tx_init_skip_cycles, true, false);
645b0db4d51STakashi Sakamoto if (err < 0)
646b0db4d51STakashi Sakamoto goto error;
647eb7b3a05STakashi Sakamoto
648ac2888b9STakashi Sakamoto // NOTE:
649ac2888b9STakashi Sakamoto // The firmware customized by M-Audio uses these commands to
650ac2888b9STakashi Sakamoto // start transmitting stream. This is not usual way.
651ac2888b9STakashi Sakamoto if (bebob->maudio_special_quirk) {
652ac2888b9STakashi Sakamoto err = bebob->spec->rate->set(bebob, curr_rate);
6533149ac48STakashi Sakamoto if (err < 0) {
6543149ac48STakashi Sakamoto dev_err(&bebob->unit->device,
6553149ac48STakashi Sakamoto "fail to ensure sampling rate: %d\n",
6563149ac48STakashi Sakamoto err);
657ac2888b9STakashi Sakamoto goto error;
6583149ac48STakashi Sakamoto }
6593149ac48STakashi Sakamoto }
6603149ac48STakashi Sakamoto
66126541cb1STakashi Sakamoto // Some devices postpone start of transmission mostly for 1 sec after receives
66226541cb1STakashi Sakamoto // packets firstly.
663bdaedca7STakashi Sakamoto if (!amdtp_domain_wait_ready(&bebob->domain, READY_TIMEOUT_MS)) {
664ac2888b9STakashi Sakamoto err = -ETIMEDOUT;
665ac2888b9STakashi Sakamoto goto error;
666ac2888b9STakashi Sakamoto }
667ac2888b9STakashi Sakamoto }
668ac2888b9STakashi Sakamoto
669ac2888b9STakashi Sakamoto return 0;
670ac2888b9STakashi Sakamoto error:
671b0db4d51STakashi Sakamoto amdtp_domain_stop(&bebob->domain);
672eb7b3a05STakashi Sakamoto break_both_connections(bebob);
673eb7b3a05STakashi Sakamoto return err;
674eb7b3a05STakashi Sakamoto }
675eb7b3a05STakashi Sakamoto
snd_bebob_stream_stop_duplex(struct snd_bebob * bebob)676eb7b3a05STakashi Sakamoto void snd_bebob_stream_stop_duplex(struct snd_bebob *bebob)
677eb7b3a05STakashi Sakamoto {
6784fd6c6c7STakashi Sakamoto if (bebob->substreams_counter == 0) {
679b0db4d51STakashi Sakamoto amdtp_domain_stop(&bebob->domain);
680eb7b3a05STakashi Sakamoto break_both_connections(bebob);
6817bc93821STakashi Sakamoto
6827bc93821STakashi Sakamoto cmp_connection_release(&bebob->out_conn);
6837bc93821STakashi Sakamoto cmp_connection_release(&bebob->in_conn);
684eb7b3a05STakashi Sakamoto }
685eb7b3a05STakashi Sakamoto }
686eb7b3a05STakashi Sakamoto
687d23c2cc4STakashi Sakamoto /*
688d23c2cc4STakashi Sakamoto * This function should be called before starting streams or after stopping
689d23c2cc4STakashi Sakamoto * streams.
690d23c2cc4STakashi Sakamoto */
snd_bebob_stream_destroy_duplex(struct snd_bebob * bebob)691eb7b3a05STakashi Sakamoto void snd_bebob_stream_destroy_duplex(struct snd_bebob *bebob)
692eb7b3a05STakashi Sakamoto {
693b0db4d51STakashi Sakamoto amdtp_domain_destroy(&bebob->domain);
694b0db4d51STakashi Sakamoto
69533e41a5cSTakashi Sakamoto destroy_stream(bebob, &bebob->tx_stream);
69633e41a5cSTakashi Sakamoto destroy_stream(bebob, &bebob->rx_stream);
697eb7b3a05STakashi Sakamoto }
698eb7b3a05STakashi Sakamoto
699eb7b3a05STakashi Sakamoto /*
700eb7b3a05STakashi Sakamoto * See: Table 50: Extended Stream Format Info Format Hierarchy Level 2’
701eb7b3a05STakashi Sakamoto * in Additional AVC commands (Nov 2003, BridgeCo)
702eb7b3a05STakashi Sakamoto * Also 'Clause 12 AM824 sequence adaption layers' in IEC 61883-6:2005
703eb7b3a05STakashi Sakamoto */
704eb7b3a05STakashi Sakamoto static int
parse_stream_formation(u8 * buf,unsigned int len,struct snd_bebob_stream_formation * formation)705eb7b3a05STakashi Sakamoto parse_stream_formation(u8 *buf, unsigned int len,
706eb7b3a05STakashi Sakamoto struct snd_bebob_stream_formation *formation)
707eb7b3a05STakashi Sakamoto {
708eb7b3a05STakashi Sakamoto unsigned int i, e, channels, format;
709eb7b3a05STakashi Sakamoto
710eb7b3a05STakashi Sakamoto /*
711eb7b3a05STakashi Sakamoto * this module can support a hierarchy combination that:
712eb7b3a05STakashi Sakamoto * Root: Audio and Music (0x90)
713eb7b3a05STakashi Sakamoto * Level 1: AM824 Compound (0x40)
714eb7b3a05STakashi Sakamoto */
715eb7b3a05STakashi Sakamoto if ((buf[0] != 0x90) || (buf[1] != 0x40))
716eb7b3a05STakashi Sakamoto return -ENOSYS;
717eb7b3a05STakashi Sakamoto
718eb7b3a05STakashi Sakamoto /* check sampling rate */
719eb7b3a05STakashi Sakamoto for (i = 0; i < ARRAY_SIZE(bridgeco_freq_table); i++) {
720eb7b3a05STakashi Sakamoto if (buf[2] == bridgeco_freq_table[i])
721eb7b3a05STakashi Sakamoto break;
722eb7b3a05STakashi Sakamoto }
72333a5f989SDan Carpenter if (i == ARRAY_SIZE(bridgeco_freq_table))
724eb7b3a05STakashi Sakamoto return -ENOSYS;
725eb7b3a05STakashi Sakamoto
726eb7b3a05STakashi Sakamoto /* Avoid double count by different entries for the same rate. */
727eb7b3a05STakashi Sakamoto memset(&formation[i], 0, sizeof(struct snd_bebob_stream_formation));
728eb7b3a05STakashi Sakamoto
729eb7b3a05STakashi Sakamoto for (e = 0; e < buf[4]; e++) {
730eb7b3a05STakashi Sakamoto channels = buf[5 + e * 2];
731eb7b3a05STakashi Sakamoto format = buf[6 + e * 2];
732eb7b3a05STakashi Sakamoto
733eb7b3a05STakashi Sakamoto switch (format) {
73451fa31d4STakashi Sakamoto /* IEC 60958 Conformant, currently handled as MBLA */
735eb7b3a05STakashi Sakamoto case 0x00:
736eb7b3a05STakashi Sakamoto /* Multi bit linear audio */
737eb7b3a05STakashi Sakamoto case 0x06: /* Raw */
738eb7b3a05STakashi Sakamoto formation[i].pcm += channels;
739eb7b3a05STakashi Sakamoto break;
740eb7b3a05STakashi Sakamoto /* MIDI Conformant */
741eb7b3a05STakashi Sakamoto case 0x0d:
742eb7b3a05STakashi Sakamoto formation[i].midi += channels;
743eb7b3a05STakashi Sakamoto break;
744eb7b3a05STakashi Sakamoto /* IEC 61937-3 to 7 */
745eb7b3a05STakashi Sakamoto case 0x01:
746eb7b3a05STakashi Sakamoto case 0x02:
747eb7b3a05STakashi Sakamoto case 0x03:
748eb7b3a05STakashi Sakamoto case 0x04:
749eb7b3a05STakashi Sakamoto case 0x05:
750eb7b3a05STakashi Sakamoto /* Multi bit linear audio */
751eb7b3a05STakashi Sakamoto case 0x07: /* DVD-Audio */
752eb7b3a05STakashi Sakamoto case 0x0c: /* High Precision */
753eb7b3a05STakashi Sakamoto /* One Bit Audio */
754eb7b3a05STakashi Sakamoto case 0x08: /* (Plain) Raw */
755eb7b3a05STakashi Sakamoto case 0x09: /* (Plain) SACD */
756eb7b3a05STakashi Sakamoto case 0x0a: /* (Encoded) Raw */
757eb7b3a05STakashi Sakamoto case 0x0b: /* (Encoded) SACD */
758eb7b3a05STakashi Sakamoto /* Synchronization Stream (Stereo Raw audio) */
759eb7b3a05STakashi Sakamoto case 0x40:
760eb7b3a05STakashi Sakamoto /* Don't care */
761eb7b3a05STakashi Sakamoto case 0xff:
762eb7b3a05STakashi Sakamoto default:
763eb7b3a05STakashi Sakamoto return -ENOSYS; /* not supported */
764eb7b3a05STakashi Sakamoto }
765eb7b3a05STakashi Sakamoto }
766eb7b3a05STakashi Sakamoto
76749c7b3fcSTakashi Sakamoto if (formation[i].pcm > AM824_MAX_CHANNELS_FOR_PCM ||
76849c7b3fcSTakashi Sakamoto formation[i].midi > AM824_MAX_CHANNELS_FOR_MIDI)
769eb7b3a05STakashi Sakamoto return -ENOSYS;
770eb7b3a05STakashi Sakamoto
771eb7b3a05STakashi Sakamoto return 0;
772eb7b3a05STakashi Sakamoto }
773eb7b3a05STakashi Sakamoto
fill_stream_formations(struct snd_bebob * bebob,u8 addr[AVC_BRIDGECO_ADDR_BYTES],enum avc_bridgeco_plug_dir plug_dir,unsigned int plug_id,struct snd_bebob_stream_formation * formations)774caa27151STakashi Sakamoto static int fill_stream_formations(struct snd_bebob *bebob, u8 addr[AVC_BRIDGECO_ADDR_BYTES],
775caa27151STakashi Sakamoto enum avc_bridgeco_plug_dir plug_dir, unsigned int plug_id,
776caa27151STakashi Sakamoto struct snd_bebob_stream_formation *formations)
777eb7b3a05STakashi Sakamoto {
778caa27151STakashi Sakamoto enum avc_bridgeco_plug_type plug_type;
779eb7b3a05STakashi Sakamoto u8 *buf;
780eb7b3a05STakashi Sakamoto unsigned int len, eid;
781eb7b3a05STakashi Sakamoto int err;
782eb7b3a05STakashi Sakamoto
783caa27151STakashi Sakamoto avc_bridgeco_fill_unit_addr(addr, plug_dir, AVC_BRIDGECO_PLUG_UNIT_ISOC, plug_id);
784caa27151STakashi Sakamoto
785caa27151STakashi Sakamoto err = avc_bridgeco_get_plug_type(bebob->unit, addr, &plug_type);
786caa27151STakashi Sakamoto if (err < 0) {
787caa27151STakashi Sakamoto dev_err(&bebob->unit->device,
788caa27151STakashi Sakamoto "Fail to get type for isoc %d plug 0: %d\n", plug_dir, err);
789caa27151STakashi Sakamoto return err;
790caa27151STakashi Sakamoto } else if (plug_type != AVC_BRIDGECO_PLUG_TYPE_ISOC)
791caa27151STakashi Sakamoto return -ENXIO;
792caa27151STakashi Sakamoto
793eb7b3a05STakashi Sakamoto buf = kmalloc(FORMAT_MAXIMUM_LENGTH, GFP_KERNEL);
794eb7b3a05STakashi Sakamoto if (buf == NULL)
795eb7b3a05STakashi Sakamoto return -ENOMEM;
796eb7b3a05STakashi Sakamoto
797caa27151STakashi Sakamoto for (eid = 0; eid < SND_BEBOB_STRM_FMT_ENTRIES; ++eid) {
798caa27151STakashi Sakamoto avc_bridgeco_fill_unit_addr(addr, plug_dir, AVC_BRIDGECO_PLUG_UNIT_ISOC, plug_id);
799eb7b3a05STakashi Sakamoto
800eb7b3a05STakashi Sakamoto len = FORMAT_MAXIMUM_LENGTH;
801caa27151STakashi Sakamoto err = avc_bridgeco_get_plug_strm_fmt(bebob->unit, addr, buf, &len, eid);
802caa27151STakashi Sakamoto // No entries remained.
803eb7b3a05STakashi Sakamoto if (err == -EINVAL && eid > 0) {
804eb7b3a05STakashi Sakamoto err = 0;
805eb7b3a05STakashi Sakamoto break;
806eb7b3a05STakashi Sakamoto } else if (err < 0) {
807eb7b3a05STakashi Sakamoto dev_err(&bebob->unit->device,
808caa27151STakashi Sakamoto "fail to get stream format %d for isoc %d plug %d:%d\n",
809caa27151STakashi Sakamoto eid, plug_dir, plug_id, err);
810eb7b3a05STakashi Sakamoto break;
811eb7b3a05STakashi Sakamoto }
812eb7b3a05STakashi Sakamoto
813eb7b3a05STakashi Sakamoto err = parse_stream_formation(buf, len, formations);
814eb7b3a05STakashi Sakamoto if (err < 0)
815eb7b3a05STakashi Sakamoto break;
816eb7b3a05STakashi Sakamoto }
817eb7b3a05STakashi Sakamoto
818eb7b3a05STakashi Sakamoto kfree(buf);
819eb7b3a05STakashi Sakamoto return err;
820eb7b3a05STakashi Sakamoto }
821eb7b3a05STakashi Sakamoto
detect_midi_ports(struct snd_bebob * bebob,const struct snd_bebob_stream_formation * formats,u8 addr[AVC_BRIDGECO_ADDR_BYTES],enum avc_bridgeco_plug_dir plug_dir,unsigned int plug_count,unsigned int * midi_ports)8225c6ea94fSTakashi Sakamoto static int detect_midi_ports(struct snd_bebob *bebob,
8235c6ea94fSTakashi Sakamoto const struct snd_bebob_stream_formation *formats,
8245c6ea94fSTakashi Sakamoto u8 addr[AVC_BRIDGECO_ADDR_BYTES], enum avc_bridgeco_plug_dir plug_dir,
8255c6ea94fSTakashi Sakamoto unsigned int plug_count, unsigned int *midi_ports)
8265c6ea94fSTakashi Sakamoto {
8275c6ea94fSTakashi Sakamoto int i;
8285c6ea94fSTakashi Sakamoto int err = 0;
8295c6ea94fSTakashi Sakamoto
8305c6ea94fSTakashi Sakamoto *midi_ports = 0;
8315c6ea94fSTakashi Sakamoto
8325c6ea94fSTakashi Sakamoto /// Detect the number of available MIDI ports when packet has MIDI conformant data channel.
8335c6ea94fSTakashi Sakamoto for (i = 0; i < SND_BEBOB_STRM_FMT_ENTRIES; ++i) {
8345c6ea94fSTakashi Sakamoto if (formats[i].midi > 0)
8355c6ea94fSTakashi Sakamoto break;
8365c6ea94fSTakashi Sakamoto }
8375c6ea94fSTakashi Sakamoto if (i >= SND_BEBOB_STRM_FMT_ENTRIES)
8385c6ea94fSTakashi Sakamoto return 0;
8395c6ea94fSTakashi Sakamoto
8405c6ea94fSTakashi Sakamoto for (i = 0; i < plug_count; ++i) {
8415c6ea94fSTakashi Sakamoto enum avc_bridgeco_plug_type plug_type;
8425c6ea94fSTakashi Sakamoto unsigned int ch_count;
8435c6ea94fSTakashi Sakamoto
8445c6ea94fSTakashi Sakamoto avc_bridgeco_fill_unit_addr(addr, plug_dir, AVC_BRIDGECO_PLUG_UNIT_EXT, i);
8455c6ea94fSTakashi Sakamoto
8465c6ea94fSTakashi Sakamoto err = avc_bridgeco_get_plug_type(bebob->unit, addr, &plug_type);
8475c6ea94fSTakashi Sakamoto if (err < 0) {
8485c6ea94fSTakashi Sakamoto dev_err(&bebob->unit->device,
8495c6ea94fSTakashi Sakamoto "fail to get type for external %d plug %d: %d\n",
8505c6ea94fSTakashi Sakamoto plug_dir, i, err);
8515c6ea94fSTakashi Sakamoto break;
8525c6ea94fSTakashi Sakamoto } else if (plug_type != AVC_BRIDGECO_PLUG_TYPE_MIDI) {
8535c6ea94fSTakashi Sakamoto continue;
8545c6ea94fSTakashi Sakamoto }
8555c6ea94fSTakashi Sakamoto
8565c6ea94fSTakashi Sakamoto err = avc_bridgeco_get_plug_ch_count(bebob->unit, addr, &ch_count);
8575c6ea94fSTakashi Sakamoto if (err < 0)
8585c6ea94fSTakashi Sakamoto break;
859*6b6c17feSTakashi Sakamoto // Yamaha GO44, GO46, Terratec Phase 24, Phase x24 reports 0 for the number of
860*6b6c17feSTakashi Sakamoto // channels in external output plug 3 (MIDI type) even if it has a pair of physical
861*6b6c17feSTakashi Sakamoto // MIDI jacks. As a workaround, assume it as one.
862*6b6c17feSTakashi Sakamoto if (ch_count == 0)
863*6b6c17feSTakashi Sakamoto ch_count = 1;
8645c6ea94fSTakashi Sakamoto *midi_ports += ch_count;
8655c6ea94fSTakashi Sakamoto }
8665c6ea94fSTakashi Sakamoto
8675c6ea94fSTakashi Sakamoto return err;
8685c6ea94fSTakashi Sakamoto }
8695c6ea94fSTakashi Sakamoto
870eb7b3a05STakashi Sakamoto static int
seek_msu_sync_input_plug(struct snd_bebob * bebob)871eb7b3a05STakashi Sakamoto seek_msu_sync_input_plug(struct snd_bebob *bebob)
872eb7b3a05STakashi Sakamoto {
873eb7b3a05STakashi Sakamoto u8 plugs[AVC_PLUG_INFO_BUF_BYTES], addr[AVC_BRIDGECO_ADDR_BYTES];
874a6b598bfSTakashi Sakamoto unsigned int i;
875a6b598bfSTakashi Sakamoto enum avc_bridgeco_plug_type type;
876eb7b3a05STakashi Sakamoto int err;
877eb7b3a05STakashi Sakamoto
878eb7b3a05STakashi Sakamoto /* Get the number of Music Sub Unit for both direction. */
879eb7b3a05STakashi Sakamoto err = avc_general_get_plug_info(bebob->unit, 0x0c, 0x00, 0x00, plugs);
880eb7b3a05STakashi Sakamoto if (err < 0) {
881eb7b3a05STakashi Sakamoto dev_err(&bebob->unit->device,
882eb7b3a05STakashi Sakamoto "fail to get info for MSU in/out plugs: %d\n",
883eb7b3a05STakashi Sakamoto err);
884eb7b3a05STakashi Sakamoto goto end;
885eb7b3a05STakashi Sakamoto }
886eb7b3a05STakashi Sakamoto
887eb7b3a05STakashi Sakamoto /* seek destination plugs for 'MSU sync input' */
888eb7b3a05STakashi Sakamoto bebob->sync_input_plug = -1;
889eb7b3a05STakashi Sakamoto for (i = 0; i < plugs[0]; i++) {
890eb7b3a05STakashi Sakamoto avc_bridgeco_fill_msu_addr(addr, AVC_BRIDGECO_PLUG_DIR_IN, i);
891eb7b3a05STakashi Sakamoto err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type);
892eb7b3a05STakashi Sakamoto if (err < 0) {
893eb7b3a05STakashi Sakamoto dev_err(&bebob->unit->device,
894eb7b3a05STakashi Sakamoto "fail to get type for MSU in plug %d: %d\n",
895eb7b3a05STakashi Sakamoto i, err);
896eb7b3a05STakashi Sakamoto goto end;
897eb7b3a05STakashi Sakamoto }
898eb7b3a05STakashi Sakamoto
899eb7b3a05STakashi Sakamoto if (type == AVC_BRIDGECO_PLUG_TYPE_SYNC) {
900eb7b3a05STakashi Sakamoto bebob->sync_input_plug = i;
901eb7b3a05STakashi Sakamoto break;
902eb7b3a05STakashi Sakamoto }
903eb7b3a05STakashi Sakamoto }
904eb7b3a05STakashi Sakamoto end:
905eb7b3a05STakashi Sakamoto return err;
906eb7b3a05STakashi Sakamoto }
907eb7b3a05STakashi Sakamoto
snd_bebob_stream_discover(struct snd_bebob * bebob)908eb7b3a05STakashi Sakamoto int snd_bebob_stream_discover(struct snd_bebob *bebob)
909eb7b3a05STakashi Sakamoto {
9106b9866c8SJulia Lawall const struct snd_bebob_clock_spec *clk_spec = bebob->spec->clock;
911eb7b3a05STakashi Sakamoto u8 plugs[AVC_PLUG_INFO_BUF_BYTES], addr[AVC_BRIDGECO_ADDR_BYTES];
912eb7b3a05STakashi Sakamoto int err;
913eb7b3a05STakashi Sakamoto
914eb7b3a05STakashi Sakamoto /* the number of plugs for isoc in/out, ext in/out */
915eb7b3a05STakashi Sakamoto err = avc_general_get_plug_info(bebob->unit, 0x1f, 0x07, 0x00, plugs);
916eb7b3a05STakashi Sakamoto if (err < 0) {
917eb7b3a05STakashi Sakamoto dev_err(&bebob->unit->device,
918eb7b3a05STakashi Sakamoto "fail to get info for isoc/external in/out plugs: %d\n",
919eb7b3a05STakashi Sakamoto err);
920eb7b3a05STakashi Sakamoto goto end;
921eb7b3a05STakashi Sakamoto }
922eb7b3a05STakashi Sakamoto
923eb7b3a05STakashi Sakamoto /*
924eb7b3a05STakashi Sakamoto * This module supports at least one isoc input plug and one isoc
925eb7b3a05STakashi Sakamoto * output plug.
926eb7b3a05STakashi Sakamoto */
927eb7b3a05STakashi Sakamoto if ((plugs[0] == 0) || (plugs[1] == 0)) {
928eb7b3a05STakashi Sakamoto err = -ENOSYS;
929eb7b3a05STakashi Sakamoto goto end;
930eb7b3a05STakashi Sakamoto }
931eb7b3a05STakashi Sakamoto
932caa27151STakashi Sakamoto err = fill_stream_formations(bebob, addr, AVC_BRIDGECO_PLUG_DIR_IN, 0,
933caa27151STakashi Sakamoto bebob->rx_stream_formations);
934eb7b3a05STakashi Sakamoto if (err < 0)
935eb7b3a05STakashi Sakamoto goto end;
936eb7b3a05STakashi Sakamoto
937caa27151STakashi Sakamoto err = fill_stream_formations(bebob, addr, AVC_BRIDGECO_PLUG_DIR_OUT, 0,
938caa27151STakashi Sakamoto bebob->tx_stream_formations);
939eb7b3a05STakashi Sakamoto if (err < 0)
940eb7b3a05STakashi Sakamoto goto end;
941eb7b3a05STakashi Sakamoto
942*6b6c17feSTakashi Sakamoto err = detect_midi_ports(bebob, bebob->tx_stream_formations, addr, AVC_BRIDGECO_PLUG_DIR_IN,
9435c6ea94fSTakashi Sakamoto plugs[2], &bebob->midi_input_ports);
9445c6ea94fSTakashi Sakamoto if (err < 0)
945eb7b3a05STakashi Sakamoto goto end;
946eb7b3a05STakashi Sakamoto
947*6b6c17feSTakashi Sakamoto err = detect_midi_ports(bebob, bebob->rx_stream_formations, addr, AVC_BRIDGECO_PLUG_DIR_OUT,
9485c6ea94fSTakashi Sakamoto plugs[3], &bebob->midi_output_ports);
9495c6ea94fSTakashi Sakamoto if (err < 0)
950eb7b3a05STakashi Sakamoto goto end;
951eb7b3a05STakashi Sakamoto
952eb7b3a05STakashi Sakamoto /* for check source of clock later */
9531fc9522aSTakashi Sakamoto if (!clk_spec)
954eb7b3a05STakashi Sakamoto err = seek_msu_sync_input_plug(bebob);
955eb7b3a05STakashi Sakamoto end:
956eb7b3a05STakashi Sakamoto return err;
957eb7b3a05STakashi Sakamoto }
958618eabeaSTakashi Sakamoto
snd_bebob_stream_lock_changed(struct snd_bebob * bebob)959618eabeaSTakashi Sakamoto void snd_bebob_stream_lock_changed(struct snd_bebob *bebob)
960618eabeaSTakashi Sakamoto {
961618eabeaSTakashi Sakamoto bebob->dev_lock_changed = true;
962618eabeaSTakashi Sakamoto wake_up(&bebob->hwdep_wait);
963618eabeaSTakashi Sakamoto }
964618eabeaSTakashi Sakamoto
snd_bebob_stream_lock_try(struct snd_bebob * bebob)965618eabeaSTakashi Sakamoto int snd_bebob_stream_lock_try(struct snd_bebob *bebob)
966618eabeaSTakashi Sakamoto {
967618eabeaSTakashi Sakamoto int err;
968618eabeaSTakashi Sakamoto
969618eabeaSTakashi Sakamoto spin_lock_irq(&bebob->lock);
970618eabeaSTakashi Sakamoto
971618eabeaSTakashi Sakamoto /* user land lock this */
972618eabeaSTakashi Sakamoto if (bebob->dev_lock_count < 0) {
973618eabeaSTakashi Sakamoto err = -EBUSY;
974618eabeaSTakashi Sakamoto goto end;
975618eabeaSTakashi Sakamoto }
976618eabeaSTakashi Sakamoto
977618eabeaSTakashi Sakamoto /* this is the first time */
978618eabeaSTakashi Sakamoto if (bebob->dev_lock_count++ == 0)
979618eabeaSTakashi Sakamoto snd_bebob_stream_lock_changed(bebob);
980618eabeaSTakashi Sakamoto err = 0;
981618eabeaSTakashi Sakamoto end:
982618eabeaSTakashi Sakamoto spin_unlock_irq(&bebob->lock);
983618eabeaSTakashi Sakamoto return err;
984618eabeaSTakashi Sakamoto }
985618eabeaSTakashi Sakamoto
snd_bebob_stream_lock_release(struct snd_bebob * bebob)986618eabeaSTakashi Sakamoto void snd_bebob_stream_lock_release(struct snd_bebob *bebob)
987618eabeaSTakashi Sakamoto {
988618eabeaSTakashi Sakamoto spin_lock_irq(&bebob->lock);
989618eabeaSTakashi Sakamoto
990618eabeaSTakashi Sakamoto if (WARN_ON(bebob->dev_lock_count <= 0))
991618eabeaSTakashi Sakamoto goto end;
992618eabeaSTakashi Sakamoto if (--bebob->dev_lock_count == 0)
993618eabeaSTakashi Sakamoto snd_bebob_stream_lock_changed(bebob);
994618eabeaSTakashi Sakamoto end:
995618eabeaSTakashi Sakamoto spin_unlock_irq(&bebob->lock);
996618eabeaSTakashi Sakamoto }
997