1/*
  2 * bebob_command.c - driver for BeBoB based devices
  3 *
  4 * Copyright (c) 2013-2014 Takashi Sakamoto
  5 *
  6 * Licensed under the terms of the GNU General Public License, version 2.
  7 */
  8
  9#include "./bebob.h"
 10
 11int avc_audio_set_selector(struct fw_unit *unit, unsigned int subunit_id,
 12			   unsigned int fb_id, unsigned int num)
 13{
 14	u8 *buf;
 15	int err;
 16
 17	buf = kzalloc(12, GFP_KERNEL);
 18	if (buf == NULL)
 19		return -ENOMEM;
 20
 21	buf[0]  = 0x00;		/* AV/C CONTROL */
 22	buf[1]  = 0x08 | (0x07 & subunit_id);	/* AUDIO SUBUNIT ID */
 23	buf[2]  = 0xb8;		/* FUNCTION BLOCK  */
 24	buf[3]  = 0x80;		/* type is 'selector'*/
 25	buf[4]  = 0xff & fb_id;	/* function block id */
 26	buf[5]  = 0x10;		/* control attribute is CURRENT */
 27	buf[6]  = 0x02;		/* selector length is 2 */
 28	buf[7]  = 0xff & num;	/* input function block plug number */
 29	buf[8]  = 0x01;		/* control selector is SELECTOR_CONTROL */
 30
 31	err = fcp_avc_transaction(unit, buf, 12, buf, 12,
 32				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
 33				  BIT(6) | BIT(7) | BIT(8));
 34	if (err > 0 && err < 9)
 35		err = -EIO;
 36	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
 37		err = -ENOSYS;
 38	else if (buf[0] == 0x0a) /* REJECTED */
 39		err = -EINVAL;
 40	else if (err > 0)
 41		err = 0;
 42
 43	kfree(buf);
 44	return err;
 45}
 46
 47int avc_audio_get_selector(struct fw_unit *unit, unsigned int subunit_id,
 48			   unsigned int fb_id, unsigned int *num)
 49{
 50	u8 *buf;
 51	int err;
 52
 53	buf = kzalloc(12, GFP_KERNEL);
 54	if (buf == NULL)
 55		return -ENOMEM;
 56
 57	buf[0]  = 0x01;		/* AV/C STATUS */
 58	buf[1]  = 0x08 | (0x07 & subunit_id);	/* AUDIO SUBUNIT ID */
 59	buf[2]  = 0xb8;		/* FUNCTION BLOCK */
 60	buf[3]  = 0x80;		/* type is 'selector'*/
 61	buf[4]  = 0xff & fb_id;	/* function block id */
 62	buf[5]  = 0x10;		/* control attribute is CURRENT */
 63	buf[6]  = 0x02;		/* selector length is 2 */
 64	buf[7]  = 0xff;		/* input function block plug number */
 65	buf[8]  = 0x01;		/* control selector is SELECTOR_CONTROL */
 66
 67	err = fcp_avc_transaction(unit, buf, 12, buf, 12,
 68				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
 69				  BIT(6) | BIT(8));
 70	if (err > 0 && err < 9)
 71		err = -EIO;
 72	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
 73		err = -ENOSYS;
 74	else if (buf[0] == 0x0a) /* REJECTED */
 75		err = -EINVAL;
 76	else if (buf[0] == 0x0b) /* IN TRANSITION */
 77		err = -EAGAIN;
 78	if (err < 0)
 79		goto end;
 80
 81	*num = buf[7];
 82	err = 0;
 83end:
 84	kfree(buf);
 85	return err;
 86}
 87
 88static inline void
 89avc_bridgeco_fill_extension_addr(u8 *buf, u8 *addr)
 90{
 91	buf[1] = addr[0];
 92	memcpy(buf + 4, addr + 1, 5);
 93}
 94
 95static inline void
 96avc_bridgeco_fill_plug_info_extension_command(u8 *buf, u8 *addr,
 97					      unsigned int itype)
 98{
 99	buf[0] = 0x01;	/* AV/C STATUS */
100	buf[2] = 0x02;	/* AV/C GENERAL PLUG INFO */
101	buf[3] = 0xc0;	/* BridgeCo extension */
102	avc_bridgeco_fill_extension_addr(buf, addr);
103	buf[9] = itype;	/* info type */
104}
105
106int avc_bridgeco_get_plug_type(struct fw_unit *unit,
107			       u8 addr[AVC_BRIDGECO_ADDR_BYTES],
108			       enum avc_bridgeco_plug_type *type)
109{
110	u8 *buf;
111	int err;
112
113	buf = kzalloc(12, GFP_KERNEL);
114	if (buf == NULL)
115		return -ENOMEM;
116
117	/* Info type is 'plug type'. */
118	avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x00);
119
120	err = fcp_avc_transaction(unit, buf, 12, buf, 12,
121				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
122				  BIT(6) | BIT(7) | BIT(9));
123	if ((err >= 0) && (err < 8))
124		err = -EIO;
125	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
126		err = -ENOSYS;
127	else if (buf[0] == 0x0a) /* REJECTED */
128		err = -EINVAL;
129	else if (buf[0] == 0x0b) /* IN TRANSITION */
130		err = -EAGAIN;
131	if (err < 0)
132		goto end;
133
134	*type = buf[10];
135	err = 0;
136end:
137	kfree(buf);
138	return err;
139}
140
141int avc_bridgeco_get_plug_ch_pos(struct fw_unit *unit,
142				 u8 addr[AVC_BRIDGECO_ADDR_BYTES],
143				 u8 *buf, unsigned int len)
144{
145	int err;
146
147	/* Info type is 'channel position'. */
148	avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x03);
149
150	err = fcp_avc_transaction(unit, buf, 12, buf, 256,
151				  BIT(1) | BIT(2) | BIT(3) | BIT(4) |
152				  BIT(5) | BIT(6) | BIT(7) | BIT(9));
153	if ((err >= 0) && (err < 8))
154		err = -EIO;
155	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
156		err = -ENOSYS;
157	else if (buf[0] == 0x0a) /* REJECTED */
158		err = -EINVAL;
159	else if (buf[0] == 0x0b) /* IN TRANSITION */
160		err = -EAGAIN;
161	if (err < 0)
162		goto end;
163
164	/* Pick up specific data. */
165	memmove(buf, buf + 10, err - 10);
166	err = 0;
167end:
168	return err;
169}
170
171int avc_bridgeco_get_plug_section_type(struct fw_unit *unit,
172				       u8 addr[AVC_BRIDGECO_ADDR_BYTES],
173				       unsigned int id, u8 *type)
174{
175	u8 *buf;
176	int err;
177
178	/* section info includes charactors but this module don't need it */
179	buf = kzalloc(12, GFP_KERNEL);
180	if (buf == NULL)
181		return -ENOMEM;
182
183	/* Info type is 'section info'. */
184	avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x07);
185	buf[10] = 0xff & ++id;	/* section id */
186
187	err = fcp_avc_transaction(unit, buf, 12, buf, 12,
188				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
189				  BIT(6) | BIT(7) | BIT(9) | BIT(10));
190	if ((err >= 0) && (err < 8))
191		err = -EIO;
192	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
193		err = -ENOSYS;
194	else if (buf[0] == 0x0a) /* REJECTED */
195		err = -EINVAL;
196	else if (buf[0] == 0x0b) /* IN TRANSITION */
197		err = -EAGAIN;
198	if (err < 0)
199		goto end;
200
201	*type = buf[11];
202	err = 0;
203end:
204	kfree(buf);
205	return err;
206}
207
208int avc_bridgeco_get_plug_input(struct fw_unit *unit,
209				u8 addr[AVC_BRIDGECO_ADDR_BYTES], u8 input[7])
210{
211	int err;
212	u8 *buf;
213
214	buf = kzalloc(18, GFP_KERNEL);
215	if (buf == NULL)
216		return -ENOMEM;
217
218	/* Info type is 'plug input'. */
219	avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x05);
220
221	err = fcp_avc_transaction(unit, buf, 16, buf, 16,
222				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
223				  BIT(6) | BIT(7));
224	if ((err >= 0) && (err < 8))
225		err = -EIO;
226	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
227		err = -ENOSYS;
228	else if (buf[0] == 0x0a) /* REJECTED */
229		err = -EINVAL;
230	else if (buf[0] == 0x0b) /* IN TRANSITION */
231		err = -EAGAIN;
232	if (err < 0)
233		goto end;
234
235	memcpy(input, buf + 10, 5);
236	err = 0;
237end:
238	kfree(buf);
239	return err;
240}
241
242int avc_bridgeco_get_plug_strm_fmt(struct fw_unit *unit,
243				   u8 addr[AVC_BRIDGECO_ADDR_BYTES], u8 *buf,
244				   unsigned int *len, unsigned int eid)
245{
246	int err;
247
248	/* check given buffer */
249	if ((buf == NULL) || (*len < 12)) {
250		err = -EINVAL;
251		goto end;
252	}
253
254	buf[0] = 0x01;	/* AV/C STATUS */
255	buf[2] = 0x2f;	/* AV/C STREAM FORMAT SUPPORT */
256	buf[3] = 0xc1;	/* Bridgeco extension - List Request */
257	avc_bridgeco_fill_extension_addr(buf, addr);
258	buf[10] = 0xff & eid;	/* Entry ID */
259
260	err = fcp_avc_transaction(unit, buf, 12, buf, *len,
261				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
262				  BIT(6) | BIT(7) | BIT(10));
263	if ((err >= 0) && (err < 12))
264		err = -EIO;
265	else if (buf[0] == 0x08)        /* NOT IMPLEMENTED */
266		err = -ENOSYS;
267	else if (buf[0] == 0x0a)        /* REJECTED */
268		err = -EINVAL;
269	else if (buf[0] == 0x0b)        /* IN TRANSITION */
270		err = -EAGAIN;
271	else if (buf[10] != eid)
272		err = -EIO;
273	if (err < 0)
274		goto end;
275
276	/* Pick up 'stream format info'. */
277	memmove(buf, buf + 11, err - 11);
278	*len = err - 11;
279	err = 0;
280end:
281	return err;
282}