[deliverable/linux.git] / sound / firewire / bebob / bebob_command.c

/*
 * bebob_command.c - driver for BeBoB based devices
 *
 * Copyright (c) 2013-2014 Takashi Sakamoto
 *
 * Licensed under the terms of the GNU General Public License, version 2.
 */

#include "./bebob.h"

int avc_audio_set_selector(struct fw_unit *unit, unsigned int subunit_id,
			   unsigned int fb_id, unsigned int num)
{
	u8 *buf;
	int err;

	buf = kzalloc(12, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;

	buf[0]  = 0x00;		/* AV/C CONTROL */
	buf[1]  = 0x08 | (0x07 & subunit_id);	/* AUDIO SUBUNIT ID */
	buf[2]  = 0xb8;		/* FUNCTION BLOCK  */
	buf[3]  = 0x80;		/* type is 'selector'*/
	buf[4]  = 0xff & fb_id;	/* function block id */
	buf[5]  = 0x10;		/* control attribute is CURRENT */
	buf[6]  = 0x02;		/* selector length is 2 */
	buf[7]  = 0xff & num;	/* input function block plug number */
	buf[8]  = 0x01;		/* control selector is SELECTOR_CONTROL */

	err = fcp_avc_transaction(unit, buf, 12, buf, 12,
				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
				  BIT(6) | BIT(7) | BIT(8));
	if (err > 0 && err < 9)
		err = -EIO;
	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
		err = -ENOSYS;
	else if (buf[0] == 0x0a) /* REJECTED */
		err = -EINVAL;
	else if (err > 0)
		err = 0;

	kfree(buf);
	return err;
}

int avc_audio_get_selector(struct fw_unit *unit, unsigned int subunit_id,
			   unsigned int fb_id, unsigned int *num)
{
	u8 *buf;
	int err;

	buf = kzalloc(12, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;

	buf[0]  = 0x01;		/* AV/C STATUS */
	buf[1]  = 0x08 | (0x07 & subunit_id);	/* AUDIO SUBUNIT ID */
	buf[2]  = 0xb8;		/* FUNCTION BLOCK */
	buf[3]  = 0x80;		/* type is 'selector'*/
	buf[4]  = 0xff & fb_id;	/* function block id */
	buf[5]  = 0x10;		/* control attribute is CURRENT */
	buf[6]  = 0x02;		/* selector length is 2 */
	buf[7]  = 0xff;		/* input function block plug number */
	buf[8]  = 0x01;		/* control selector is SELECTOR_CONTROL */

	err = fcp_avc_transaction(unit, buf, 12, buf, 12,
				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
				  BIT(6) | BIT(8));
	if (err > 0 && err < 9)
		err = -EIO;
	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
		err = -ENOSYS;
	else if (buf[0] == 0x0a) /* REJECTED */
		err = -EINVAL;
	else if (buf[0] == 0x0b) /* IN TRANSITION */
		err = -EAGAIN;
	if (err < 0)
		goto end;

	*num = buf[7];
	err = 0;
end:
	kfree(buf);
	return err;
}

static inline void
avc_bridgeco_fill_extension_addr(u8 *buf, u8 *addr)
{
	buf[1] = addr[0];
	memcpy(buf + 4, addr + 1, 5);
}

static inline void
avc_bridgeco_fill_plug_info_extension_command(u8 *buf, u8 *addr,
					      unsigned int itype)
{
	buf[0] = 0x01;	/* AV/C STATUS */
	buf[2] = 0x02;	/* AV/C GENERAL PLUG INFO */
	buf[3] = 0xc0;	/* BridgeCo extension */
	avc_bridgeco_fill_extension_addr(buf, addr);
	buf[9] = itype;	/* info type */
}

int avc_bridgeco_get_plug_type(struct fw_unit *unit,
			       u8 addr[AVC_BRIDGECO_ADDR_BYTES],
			       enum avc_bridgeco_plug_type *type)
{
	u8 *buf;
	int err;

	buf = kzalloc(12, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;

	/* Info type is 'plug type'. */
	avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x00);

	err = fcp_avc_transaction(unit, buf, 12, buf, 12,
				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
				  BIT(6) | BIT(7) | BIT(9));
	if ((err >= 0) && (err < 8))
		err = -EIO;
	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
		err = -ENOSYS;
	else if (buf[0] == 0x0a) /* REJECTED */
		err = -EINVAL;
	else if (buf[0] == 0x0b) /* IN TRANSITION */
		err = -EAGAIN;
	if (err < 0)
		goto end;

	*type = buf[10];
	err = 0;
end:
	kfree(buf);
	return err;
}

int avc_bridgeco_get_plug_ch_pos(struct fw_unit *unit,
				 u8 addr[AVC_BRIDGECO_ADDR_BYTES],
				 u8 *buf, unsigned int len)
{
	int err;

	/* Info type is 'channel position'. */
	avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x03);

	err = fcp_avc_transaction(unit, buf, 12, buf, 256,
				  BIT(1) | BIT(2) | BIT(3) | BIT(4) |
				  BIT(5) | BIT(6) | BIT(7) | BIT(9));
	if ((err >= 0) && (err < 8))
		err = -EIO;
	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
		err = -ENOSYS;
	else if (buf[0] == 0x0a) /* REJECTED */
		err = -EINVAL;
	else if (buf[0] == 0x0b) /* IN TRANSITION */
		err = -EAGAIN;
	if (err < 0)
		goto end;

	/* Pick up specific data. */
	memmove(buf, buf + 10, err - 10);
	err = 0;
end:
	return err;
}

int avc_bridgeco_get_plug_section_type(struct fw_unit *unit,
				       u8 addr[AVC_BRIDGECO_ADDR_BYTES],
				       unsigned int id, u8 *type)
{
	u8 *buf;
	int err;

	/* section info includes charactors but this module don't need it */
	buf = kzalloc(12, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;

	/* Info type is 'section info'. */
	avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x07);
	buf[10] = 0xff & ++id;	/* section id */

	err = fcp_avc_transaction(unit, buf, 12, buf, 12,
				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
				  BIT(6) | BIT(7) | BIT(9) | BIT(10));
	if ((err >= 0) && (err < 8))
		err = -EIO;
	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
		err = -ENOSYS;
	else if (buf[0] == 0x0a) /* REJECTED */
		err = -EINVAL;
	else if (buf[0] == 0x0b) /* IN TRANSITION */
		err = -EAGAIN;
	if (err < 0)
		goto end;

	*type = buf[11];
	err = 0;
end:
	kfree(buf);
	return err;
}

int avc_bridgeco_get_plug_input(struct fw_unit *unit,
				u8 addr[AVC_BRIDGECO_ADDR_BYTES], u8 input[7])
{
	int err;
	u8 *buf;

	buf = kzalloc(18, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;

	/* Info type is 'plug input'. */
	avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x05);

	err = fcp_avc_transaction(unit, buf, 16, buf, 16,
				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
				  BIT(6) | BIT(7));
	if ((err >= 0) && (err < 8))
		err = -EIO;
	else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
		err = -ENOSYS;
	else if (buf[0] == 0x0a) /* REJECTED */
		err = -EINVAL;
	else if (buf[0] == 0x0b) /* IN TRANSITION */
		err = -EAGAIN;
	if (err < 0)
		goto end;

	memcpy(input, buf + 10, 5);
	err = 0;
end:
	kfree(buf);
	return err;
}

int avc_bridgeco_get_plug_strm_fmt(struct fw_unit *unit,
				   u8 addr[AVC_BRIDGECO_ADDR_BYTES], u8 *buf,
				   unsigned int *len, unsigned int eid)
{
	int err;

	/* check given buffer */
	if ((buf == NULL) || (*len < 12)) {
		err = -EINVAL;
		goto end;
	}

	buf[0] = 0x01;	/* AV/C STATUS */
	buf[2] = 0x2f;	/* AV/C STREAM FORMAT SUPPORT */
	buf[3] = 0xc1;	/* Bridgeco extension - List Request */
	avc_bridgeco_fill_extension_addr(buf, addr);
	buf[10] = 0xff & eid;	/* Entry ID */

	err = fcp_avc_transaction(unit, buf, 12, buf, *len,
				  BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
				  BIT(6) | BIT(7) | BIT(10));
	if ((err >= 0) && (err < 12))
		err = -EIO;
	else if (buf[0] == 0x08)        /* NOT IMPLEMENTED */
		err = -ENOSYS;
	else if (buf[0] == 0x0a)        /* REJECTED */
		err = -EINVAL;
	else if (buf[0] == 0x0b)        /* IN TRANSITION */
		err = -EAGAIN;
	else if (buf[10] != eid)
		err = -EIO;
	if (err < 0)
		goto end;

	/* Pick up 'stream format info'. */
	memmove(buf, buf + 11, err - 11);
	*len = err - 11;
	err = 0;
end:
	return err;
}
Commit	Line	Data
eb7b3a05 TS	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
1fc9522a TS	11	int 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
	47	int 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;
83	end:
84	kfree(buf);
85	return err;
86	}
87
eb7b3a05 TS	88	static inline void
	89	avc_bridgeco_fill_extension_addr(u8 buf, u8 addr)
	90	{
	91	buf[1] = addr[0];
	92	memcpy(buf + 4, addr + 1, 5);
	93	}
	94
	95	static inline void
	96	avc_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
	106	int 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;
	136	end:
	137	kfree(buf);
	138	return err;
	139	}
	140
	141	int 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;
167	end:
168	return err;
169	}
170
171	int 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;
203	end:
204	kfree(buf);
205	return err;
206	}
207
208	int 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;
237	end:
238	kfree(buf);
239	return err;
240	}
241
242	int 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;
280	end:
281	return err;
282	}