xref: /OK3568_Linux_fs/kernel/drivers/usb/gadget/function/f_uac1.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * f_uac1.c -- USB Audio Class 1.0 Function (using u_audio API)
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2016 Ruslan Bilovol <ruslan.bilovol@gmail.com>
6*4882a593Smuzhiyun  * Copyright (C) 2021 Julian Scheel <julian@jusst.de>
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  * This driver doesn't expect any real Audio codec to be present
9*4882a593Smuzhiyun  * on the device - the audio streams are simply sinked to and
10*4882a593Smuzhiyun  * sourced from a virtual ALSA sound card created.
11*4882a593Smuzhiyun  *
12*4882a593Smuzhiyun  * This file is based on f_uac1.c which is
13*4882a593Smuzhiyun  *   Copyright (C) 2008 Bryan Wu <cooloney@kernel.org>
14*4882a593Smuzhiyun  *   Copyright (C) 2008 Analog Devices, Inc
15*4882a593Smuzhiyun  */
16*4882a593Smuzhiyun 
17*4882a593Smuzhiyun #include <linux/usb/audio.h>
18*4882a593Smuzhiyun #include <linux/module.h>
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun #include "u_audio.h"
21*4882a593Smuzhiyun #include "u_uac1.h"
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun /* UAC1 spec: 3.7.2.3 Audio Channel Cluster Format */
24*4882a593Smuzhiyun #define UAC1_CHANNEL_MASK 0x0FFF
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun #define USB_OUT_FU_ID	(out_feature_unit_desc->bUnitID)
27*4882a593Smuzhiyun #define USB_IN_FU_ID	(in_feature_unit_desc->bUnitID)
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #define EPIN_EN(_opts) ((_opts)->p_chmask != 0)
30*4882a593Smuzhiyun #define EPOUT_EN(_opts) ((_opts)->c_chmask != 0)
31*4882a593Smuzhiyun #define FUIN_EN(_opts) ((_opts)->p_mute_present \
32*4882a593Smuzhiyun 			|| (_opts)->p_volume_present)
33*4882a593Smuzhiyun #define FUOUT_EN(_opts) ((_opts)->c_mute_present \
34*4882a593Smuzhiyun 			|| (_opts)->c_volume_present)
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun struct f_uac1 {
37*4882a593Smuzhiyun 	struct g_audio g_audio;
38*4882a593Smuzhiyun 	u8 ac_intf, as_in_intf, as_out_intf;
39*4882a593Smuzhiyun 	u8 ac_alt, as_in_alt, as_out_alt;	/* needed for get_alt() */
40*4882a593Smuzhiyun 
41*4882a593Smuzhiyun 	struct usb_ctrlrequest setup_cr;	/* will be used in data stage */
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun 	/* Interrupt IN endpoint of AC interface */
44*4882a593Smuzhiyun 	struct usb_ep	*int_ep;
45*4882a593Smuzhiyun 	atomic_t	int_count;
46*4882a593Smuzhiyun 	int ctl_id;		/* EP id */
47*4882a593Smuzhiyun 	int c_srate;	/* current capture srate */
48*4882a593Smuzhiyun 	int p_srate;	/* current playback prate */
49*4882a593Smuzhiyun };
50*4882a593Smuzhiyun 
func_to_uac1(struct usb_function * f)51*4882a593Smuzhiyun static inline struct f_uac1 *func_to_uac1(struct usb_function *f)
52*4882a593Smuzhiyun {
53*4882a593Smuzhiyun 	return container_of(f, struct f_uac1, g_audio.func);
54*4882a593Smuzhiyun }
55*4882a593Smuzhiyun 
g_audio_to_uac1_opts(struct g_audio * audio)56*4882a593Smuzhiyun static inline struct f_uac1_opts *g_audio_to_uac1_opts(struct g_audio *audio)
57*4882a593Smuzhiyun {
58*4882a593Smuzhiyun 	return container_of(audio->func.fi, struct f_uac1_opts, func_inst);
59*4882a593Smuzhiyun }
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun static struct usb_interface_assoc_descriptor iad_desc = {
62*4882a593Smuzhiyun 	.bLength = sizeof(iad_desc),
63*4882a593Smuzhiyun 	.bDescriptorType = USB_DT_INTERFACE_ASSOCIATION,
64*4882a593Smuzhiyun 	/* .bFirstInterface = DYNAMIC */
65*4882a593Smuzhiyun 	/* .bInterfaceCount = DYNAMIC */
66*4882a593Smuzhiyun 	.bFunctionClass = USB_CLASS_AUDIO,
67*4882a593Smuzhiyun 	.bFunctionSubClass = USB_SUBCLASS_AUDIOSTREAMING,
68*4882a593Smuzhiyun 	.bFunctionProtocol = UAC_VERSION_1,
69*4882a593Smuzhiyun };
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun /*
72*4882a593Smuzhiyun  * DESCRIPTORS ... most are static, but strings and full
73*4882a593Smuzhiyun  * configuration descriptors are built on demand.
74*4882a593Smuzhiyun  */
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun /*
77*4882a593Smuzhiyun  * We have three interfaces - one AudioControl and two AudioStreaming
78*4882a593Smuzhiyun  *
79*4882a593Smuzhiyun  * The driver implements a simple UAC_1 topology.
80*4882a593Smuzhiyun  * USB-OUT -> IT_1 -> OT_2 -> ALSA_Capture
81*4882a593Smuzhiyun  * ALSA_Playback -> IT_3 -> OT_4 -> USB-IN
82*4882a593Smuzhiyun  */
83*4882a593Smuzhiyun 
84*4882a593Smuzhiyun /* B.3.1  Standard AC Interface Descriptor */
85*4882a593Smuzhiyun static struct usb_interface_descriptor ac_interface_desc = {
86*4882a593Smuzhiyun 	.bLength =		USB_DT_INTERFACE_SIZE,
87*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_INTERFACE,
88*4882a593Smuzhiyun 	/* .bNumEndpoints =	DYNAMIC */
89*4882a593Smuzhiyun 	.bInterfaceClass =	USB_CLASS_AUDIO,
90*4882a593Smuzhiyun 	.bInterfaceSubClass =	USB_SUBCLASS_AUDIOCONTROL,
91*4882a593Smuzhiyun };
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun /* B.3.2  Class-Specific AC Interface Descriptor */
94*4882a593Smuzhiyun static struct uac1_ac_header_descriptor *ac_header_desc;
95*4882a593Smuzhiyun 
96*4882a593Smuzhiyun static struct uac_input_terminal_descriptor usb_out_it_desc = {
97*4882a593Smuzhiyun 	.bLength =		UAC_DT_INPUT_TERMINAL_SIZE,
98*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_CS_INTERFACE,
99*4882a593Smuzhiyun 	.bDescriptorSubtype =	UAC_INPUT_TERMINAL,
100*4882a593Smuzhiyun 	/* .bTerminalID =	DYNAMIC */
101*4882a593Smuzhiyun 	.wTerminalType =	cpu_to_le16(UAC_TERMINAL_STREAMING),
102*4882a593Smuzhiyun 	.bAssocTerminal =	0,
103*4882a593Smuzhiyun 	.wChannelConfig =	cpu_to_le16(0x3),
104*4882a593Smuzhiyun };
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun static struct uac1_output_terminal_descriptor io_out_ot_desc = {
107*4882a593Smuzhiyun 	.bLength		= UAC_DT_OUTPUT_TERMINAL_SIZE,
108*4882a593Smuzhiyun 	.bDescriptorType	= USB_DT_CS_INTERFACE,
109*4882a593Smuzhiyun 	.bDescriptorSubtype	= UAC_OUTPUT_TERMINAL,
110*4882a593Smuzhiyun 	/* .bTerminalID =	DYNAMIC */
111*4882a593Smuzhiyun 	.wTerminalType		= cpu_to_le16(UAC_OUTPUT_TERMINAL_SPEAKER),
112*4882a593Smuzhiyun 	.bAssocTerminal		= 0,
113*4882a593Smuzhiyun 	/* .bSourceID =		DYNAMIC */
114*4882a593Smuzhiyun };
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun static struct uac_input_terminal_descriptor io_in_it_desc = {
117*4882a593Smuzhiyun 	.bLength		= UAC_DT_INPUT_TERMINAL_SIZE,
118*4882a593Smuzhiyun 	.bDescriptorType	= USB_DT_CS_INTERFACE,
119*4882a593Smuzhiyun 	.bDescriptorSubtype	= UAC_INPUT_TERMINAL,
120*4882a593Smuzhiyun 	/* .bTerminalID		= DYNAMIC */
121*4882a593Smuzhiyun 	.wTerminalType		= cpu_to_le16(UAC_INPUT_TERMINAL_MICROPHONE),
122*4882a593Smuzhiyun 	.bAssocTerminal		= 0,
123*4882a593Smuzhiyun 	.wChannelConfig		= cpu_to_le16(0x3),
124*4882a593Smuzhiyun };
125*4882a593Smuzhiyun 
126*4882a593Smuzhiyun static struct uac1_output_terminal_descriptor usb_in_ot_desc = {
127*4882a593Smuzhiyun 	.bLength =		UAC_DT_OUTPUT_TERMINAL_SIZE,
128*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_CS_INTERFACE,
129*4882a593Smuzhiyun 	.bDescriptorSubtype =	UAC_OUTPUT_TERMINAL,
130*4882a593Smuzhiyun 	/* .bTerminalID =	DYNAMIC */
131*4882a593Smuzhiyun 	.wTerminalType =	cpu_to_le16(UAC_TERMINAL_STREAMING),
132*4882a593Smuzhiyun 	.bAssocTerminal =	0,
133*4882a593Smuzhiyun 	/* .bSourceID =		DYNAMIC */
134*4882a593Smuzhiyun };
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun static struct uac_feature_unit_descriptor *in_feature_unit_desc;
137*4882a593Smuzhiyun static struct uac_feature_unit_descriptor *out_feature_unit_desc;
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun /* AC IN Interrupt Endpoint */
140*4882a593Smuzhiyun static struct usb_endpoint_descriptor fs_int_ep_desc = {
141*4882a593Smuzhiyun 	.bLength = USB_DT_ENDPOINT_SIZE,
142*4882a593Smuzhiyun 	.bDescriptorType = USB_DT_ENDPOINT,
143*4882a593Smuzhiyun 	.bEndpointAddress = USB_DIR_IN,
144*4882a593Smuzhiyun 	.bmAttributes = USB_ENDPOINT_XFER_INT,
145*4882a593Smuzhiyun 	.wMaxPacketSize = cpu_to_le16(2),
146*4882a593Smuzhiyun 	.bInterval = 1,
147*4882a593Smuzhiyun };
148*4882a593Smuzhiyun 
149*4882a593Smuzhiyun static struct usb_endpoint_descriptor ac_int_ep_desc = {
150*4882a593Smuzhiyun 	.bLength = USB_DT_ENDPOINT_SIZE,
151*4882a593Smuzhiyun 	.bDescriptorType = USB_DT_ENDPOINT,
152*4882a593Smuzhiyun 	.bEndpointAddress = USB_DIR_IN,
153*4882a593Smuzhiyun 	.bmAttributes = USB_ENDPOINT_XFER_INT,
154*4882a593Smuzhiyun 	.wMaxPacketSize = cpu_to_le16(2),
155*4882a593Smuzhiyun 	.bInterval = 4,
156*4882a593Smuzhiyun };
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun static struct usb_ss_ep_comp_descriptor ac_int_ep_desc_comp = {
159*4882a593Smuzhiyun 	.bLength = sizeof(ac_int_ep_desc_comp),
160*4882a593Smuzhiyun 	.bDescriptorType = USB_DT_SS_ENDPOINT_COMP,
161*4882a593Smuzhiyun 	.wBytesPerInterval = cpu_to_le16(2),
162*4882a593Smuzhiyun };
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun /* B.4.1  Standard AS Interface Descriptor */
165*4882a593Smuzhiyun static struct usb_interface_descriptor as_out_interface_alt_0_desc = {
166*4882a593Smuzhiyun 	.bLength =		USB_DT_INTERFACE_SIZE,
167*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_INTERFACE,
168*4882a593Smuzhiyun 	.bAlternateSetting =	0,
169*4882a593Smuzhiyun 	.bNumEndpoints =	0,
170*4882a593Smuzhiyun 	.bInterfaceClass =	USB_CLASS_AUDIO,
171*4882a593Smuzhiyun 	.bInterfaceSubClass =	USB_SUBCLASS_AUDIOSTREAMING,
172*4882a593Smuzhiyun };
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun static struct usb_interface_descriptor as_out_interface_alt_1_desc = {
175*4882a593Smuzhiyun 	.bLength =		USB_DT_INTERFACE_SIZE,
176*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_INTERFACE,
177*4882a593Smuzhiyun 	.bAlternateSetting =	1,
178*4882a593Smuzhiyun 	.bNumEndpoints =	1,
179*4882a593Smuzhiyun 	.bInterfaceClass =	USB_CLASS_AUDIO,
180*4882a593Smuzhiyun 	.bInterfaceSubClass =	USB_SUBCLASS_AUDIOSTREAMING,
181*4882a593Smuzhiyun };
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun static struct usb_interface_descriptor as_in_interface_alt_0_desc = {
184*4882a593Smuzhiyun 	.bLength =		USB_DT_INTERFACE_SIZE,
185*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_INTERFACE,
186*4882a593Smuzhiyun 	.bAlternateSetting =	0,
187*4882a593Smuzhiyun 	.bNumEndpoints =	0,
188*4882a593Smuzhiyun 	.bInterfaceClass =	USB_CLASS_AUDIO,
189*4882a593Smuzhiyun 	.bInterfaceSubClass =	USB_SUBCLASS_AUDIOSTREAMING,
190*4882a593Smuzhiyun };
191*4882a593Smuzhiyun 
192*4882a593Smuzhiyun static struct usb_interface_descriptor as_in_interface_alt_1_desc = {
193*4882a593Smuzhiyun 	.bLength =		USB_DT_INTERFACE_SIZE,
194*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_INTERFACE,
195*4882a593Smuzhiyun 	.bAlternateSetting =	1,
196*4882a593Smuzhiyun 	.bNumEndpoints =	1,
197*4882a593Smuzhiyun 	.bInterfaceClass =	USB_CLASS_AUDIO,
198*4882a593Smuzhiyun 	.bInterfaceSubClass =	USB_SUBCLASS_AUDIOSTREAMING,
199*4882a593Smuzhiyun };
200*4882a593Smuzhiyun 
201*4882a593Smuzhiyun /* B.4.2  Class-Specific AS Interface Descriptor */
202*4882a593Smuzhiyun static struct uac1_as_header_descriptor as_out_header_desc = {
203*4882a593Smuzhiyun 	.bLength =		UAC_DT_AS_HEADER_SIZE,
204*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_CS_INTERFACE,
205*4882a593Smuzhiyun 	.bDescriptorSubtype =	UAC_AS_GENERAL,
206*4882a593Smuzhiyun 	/* .bTerminalLink =	DYNAMIC */
207*4882a593Smuzhiyun 	.bDelay =		1,
208*4882a593Smuzhiyun 	.wFormatTag =		cpu_to_le16(UAC_FORMAT_TYPE_I_PCM),
209*4882a593Smuzhiyun };
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun static struct uac1_as_header_descriptor as_in_header_desc = {
212*4882a593Smuzhiyun 	.bLength =		UAC_DT_AS_HEADER_SIZE,
213*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_CS_INTERFACE,
214*4882a593Smuzhiyun 	.bDescriptorSubtype =	UAC_AS_GENERAL,
215*4882a593Smuzhiyun 	/* .bTerminalLink =	DYNAMIC */
216*4882a593Smuzhiyun 	.bDelay =		1,
217*4882a593Smuzhiyun 	.wFormatTag =		cpu_to_le16(UAC_FORMAT_TYPE_I_PCM),
218*4882a593Smuzhiyun };
219*4882a593Smuzhiyun 
220*4882a593Smuzhiyun DECLARE_UAC_FORMAT_TYPE_I_DISCRETE_DESC(UAC_MAX_RATES);
221*4882a593Smuzhiyun #define uac_format_type_i_discrete_descriptor			\
222*4882a593Smuzhiyun 	uac_format_type_i_discrete_descriptor_##UAC_MAX_RATES
223*4882a593Smuzhiyun 
224*4882a593Smuzhiyun static struct uac_format_type_i_discrete_descriptor as_out_type_i_desc = {
225*4882a593Smuzhiyun 	.bLength =		0, /* filled on rate setup */
226*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_CS_INTERFACE,
227*4882a593Smuzhiyun 	.bDescriptorSubtype =	UAC_FORMAT_TYPE,
228*4882a593Smuzhiyun 	.bFormatType =		UAC_FORMAT_TYPE_I,
229*4882a593Smuzhiyun 	.bSubframeSize =	2,
230*4882a593Smuzhiyun 	.bBitResolution =	16,
231*4882a593Smuzhiyun 	.bSamFreqType =		0, /* filled on rate setup */
232*4882a593Smuzhiyun };
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun /* Standard ISO OUT Endpoint Descriptor */
235*4882a593Smuzhiyun static struct usb_endpoint_descriptor fs_out_ep_desc  = {
236*4882a593Smuzhiyun 	.bLength =		USB_DT_ENDPOINT_AUDIO_SIZE,
237*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_ENDPOINT,
238*4882a593Smuzhiyun 	.bEndpointAddress =	USB_DIR_OUT,
239*4882a593Smuzhiyun 	.bmAttributes =		USB_ENDPOINT_SYNC_ADAPTIVE
240*4882a593Smuzhiyun 				| USB_ENDPOINT_XFER_ISOC,
241*4882a593Smuzhiyun 	/* .wMaxPacketSize = DYNAMIC */
242*4882a593Smuzhiyun 	.bInterval =		1,
243*4882a593Smuzhiyun };
244*4882a593Smuzhiyun 
245*4882a593Smuzhiyun static struct usb_endpoint_descriptor as_out_ep_desc  = {
246*4882a593Smuzhiyun 	.bLength =		USB_DT_ENDPOINT_AUDIO_SIZE,
247*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_ENDPOINT,
248*4882a593Smuzhiyun 	.bEndpointAddress =	USB_DIR_OUT,
249*4882a593Smuzhiyun 	.bmAttributes =		USB_ENDPOINT_SYNC_ADAPTIVE
250*4882a593Smuzhiyun 				| USB_ENDPOINT_XFER_ISOC,
251*4882a593Smuzhiyun 	/* .wMaxPacketSize = DYNAMIC */
252*4882a593Smuzhiyun 	.bInterval =		4,
253*4882a593Smuzhiyun };
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun static struct usb_ss_ep_comp_descriptor as_out_ep_desc_comp = {
256*4882a593Smuzhiyun 	.bLength		= sizeof(as_out_ep_desc_comp),
257*4882a593Smuzhiyun 	.bDescriptorType	= USB_DT_SS_ENDPOINT_COMP,
258*4882a593Smuzhiyun 	.wBytesPerInterval	= cpu_to_le16(UAC1_OUT_EP_MAX_PACKET_SIZE),
259*4882a593Smuzhiyun };
260*4882a593Smuzhiyun 
261*4882a593Smuzhiyun /* Class-specific AS ISO OUT Endpoint Descriptor */
262*4882a593Smuzhiyun static struct uac_iso_endpoint_descriptor as_iso_out_desc = {
263*4882a593Smuzhiyun 	.bLength =		UAC_ISO_ENDPOINT_DESC_SIZE,
264*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_CS_ENDPOINT,
265*4882a593Smuzhiyun 	.bDescriptorSubtype =	UAC_EP_GENERAL,
266*4882a593Smuzhiyun 	.bmAttributes =		1,
267*4882a593Smuzhiyun 	.bLockDelayUnits =	1,
268*4882a593Smuzhiyun 	.wLockDelay =		cpu_to_le16(1),
269*4882a593Smuzhiyun };
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun static struct uac_format_type_i_discrete_descriptor as_in_type_i_desc = {
272*4882a593Smuzhiyun 	.bLength =		0, /* filled on rate setup */
273*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_CS_INTERFACE,
274*4882a593Smuzhiyun 	.bDescriptorSubtype =	UAC_FORMAT_TYPE,
275*4882a593Smuzhiyun 	.bFormatType =		UAC_FORMAT_TYPE_I,
276*4882a593Smuzhiyun 	.bSubframeSize =	2,
277*4882a593Smuzhiyun 	.bBitResolution =	16,
278*4882a593Smuzhiyun 	.bSamFreqType =		0, /* filled on rate setup */
279*4882a593Smuzhiyun };
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun /* Standard ISO IN Endpoint Descriptor */
282*4882a593Smuzhiyun static struct usb_endpoint_descriptor fs_in_ep_desc  = {
283*4882a593Smuzhiyun 	.bLength =		USB_DT_ENDPOINT_AUDIO_SIZE,
284*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_ENDPOINT,
285*4882a593Smuzhiyun 	.bEndpointAddress =	USB_DIR_IN,
286*4882a593Smuzhiyun 	.bmAttributes =		USB_ENDPOINT_SYNC_ASYNC
287*4882a593Smuzhiyun 				| USB_ENDPOINT_XFER_ISOC,
288*4882a593Smuzhiyun 	/* .wMaxPacketSize = DYNAMIC */
289*4882a593Smuzhiyun 	.bInterval =		1,
290*4882a593Smuzhiyun };
291*4882a593Smuzhiyun 
292*4882a593Smuzhiyun static struct usb_endpoint_descriptor as_in_ep_desc  = {
293*4882a593Smuzhiyun 	.bLength =		USB_DT_ENDPOINT_AUDIO_SIZE,
294*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_ENDPOINT,
295*4882a593Smuzhiyun 	.bEndpointAddress =	USB_DIR_IN,
296*4882a593Smuzhiyun 	.bmAttributes =		USB_ENDPOINT_SYNC_ASYNC
297*4882a593Smuzhiyun 				| USB_ENDPOINT_XFER_ISOC,
298*4882a593Smuzhiyun 	/* .wMaxPacketSize = DYNAMIC */
299*4882a593Smuzhiyun 	.bInterval =		4,
300*4882a593Smuzhiyun };
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun static struct usb_ss_ep_comp_descriptor as_in_ep_desc_comp = {
303*4882a593Smuzhiyun 	.bLength		= sizeof(as_in_ep_desc_comp),
304*4882a593Smuzhiyun 	.bDescriptorType	= USB_DT_SS_ENDPOINT_COMP,
305*4882a593Smuzhiyun 	.wBytesPerInterval	= cpu_to_le16(UAC1_OUT_EP_MAX_PACKET_SIZE),
306*4882a593Smuzhiyun };
307*4882a593Smuzhiyun 
308*4882a593Smuzhiyun /* Class-specific AS ISO OUT Endpoint Descriptor */
309*4882a593Smuzhiyun static struct uac_iso_endpoint_descriptor as_iso_in_desc = {
310*4882a593Smuzhiyun 	.bLength =		UAC_ISO_ENDPOINT_DESC_SIZE,
311*4882a593Smuzhiyun 	.bDescriptorType =	USB_DT_CS_ENDPOINT,
312*4882a593Smuzhiyun 	.bDescriptorSubtype =	UAC_EP_GENERAL,
313*4882a593Smuzhiyun 	.bmAttributes =		1,
314*4882a593Smuzhiyun 	.bLockDelayUnits =	0,
315*4882a593Smuzhiyun 	.wLockDelay =		0,
316*4882a593Smuzhiyun };
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun static struct usb_descriptor_header *fs_audio_desc[] = {
319*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&iad_desc,
320*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&ac_interface_desc,
321*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&ac_header_desc,
322*4882a593Smuzhiyun 
323*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&usb_out_it_desc,
324*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&io_out_ot_desc,
325*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&out_feature_unit_desc,
326*4882a593Smuzhiyun 
327*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&io_in_it_desc,
328*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&usb_in_ot_desc,
329*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&in_feature_unit_desc,
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&fs_int_ep_desc,
332*4882a593Smuzhiyun 
333*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_interface_alt_0_desc,
334*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_interface_alt_1_desc,
335*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_header_desc,
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_type_i_desc,
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&fs_out_ep_desc,
340*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_iso_out_desc,
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_interface_alt_0_desc,
343*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_interface_alt_1_desc,
344*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_header_desc,
345*4882a593Smuzhiyun 
346*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_type_i_desc,
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&fs_in_ep_desc,
349*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_iso_in_desc,
350*4882a593Smuzhiyun 	NULL,
351*4882a593Smuzhiyun };
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun static struct usb_descriptor_header *hs_audio_desc[] = {
354*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&iad_desc,
355*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&ac_interface_desc,
356*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&ac_header_desc,
357*4882a593Smuzhiyun 
358*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&usb_out_it_desc,
359*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&io_out_ot_desc,
360*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&out_feature_unit_desc,
361*4882a593Smuzhiyun 
362*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&io_in_it_desc,
363*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&usb_in_ot_desc,
364*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&in_feature_unit_desc,
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&ac_int_ep_desc,
367*4882a593Smuzhiyun 
368*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_interface_alt_0_desc,
369*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_interface_alt_1_desc,
370*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_header_desc,
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_type_i_desc,
373*4882a593Smuzhiyun 
374*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_ep_desc,
375*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_iso_out_desc,
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_interface_alt_0_desc,
378*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_interface_alt_1_desc,
379*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_header_desc,
380*4882a593Smuzhiyun 
381*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_type_i_desc,
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_ep_desc,
384*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_iso_in_desc,
385*4882a593Smuzhiyun 	NULL,
386*4882a593Smuzhiyun };
387*4882a593Smuzhiyun 
388*4882a593Smuzhiyun static struct usb_descriptor_header *ss_audio_desc[] = {
389*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&iad_desc,
390*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&ac_interface_desc,
391*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&ac_header_desc,
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&usb_out_it_desc,
394*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&io_out_ot_desc,
395*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&out_feature_unit_desc,
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&io_in_it_desc,
398*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&usb_in_ot_desc,
399*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&in_feature_unit_desc,
400*4882a593Smuzhiyun 
401*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&ac_int_ep_desc,
402*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&ac_int_ep_desc_comp,
403*4882a593Smuzhiyun 
404*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_interface_alt_0_desc,
405*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_interface_alt_1_desc,
406*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_header_desc,
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_type_i_desc,
409*4882a593Smuzhiyun 
410*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_ep_desc,
411*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_out_ep_desc_comp,
412*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_iso_out_desc,
413*4882a593Smuzhiyun 
414*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_interface_alt_0_desc,
415*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_interface_alt_1_desc,
416*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_header_desc,
417*4882a593Smuzhiyun 
418*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_type_i_desc,
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_ep_desc,
421*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_in_ep_desc_comp,
422*4882a593Smuzhiyun 	(struct usb_descriptor_header *)&as_iso_in_desc,
423*4882a593Smuzhiyun 	NULL,
424*4882a593Smuzhiyun };
425*4882a593Smuzhiyun 
426*4882a593Smuzhiyun enum {
427*4882a593Smuzhiyun 	STR_ASSOC,
428*4882a593Smuzhiyun 	STR_AC_IF,
429*4882a593Smuzhiyun 	STR_USB_OUT_IT,
430*4882a593Smuzhiyun 	STR_USB_OUT_IT_CH_NAMES,
431*4882a593Smuzhiyun 	STR_IO_OUT_OT,
432*4882a593Smuzhiyun 	STR_IO_IN_IT,
433*4882a593Smuzhiyun 	STR_IO_IN_IT_CH_NAMES,
434*4882a593Smuzhiyun 	STR_USB_IN_OT,
435*4882a593Smuzhiyun 	STR_FU_IN,
436*4882a593Smuzhiyun 	STR_FU_OUT,
437*4882a593Smuzhiyun 	STR_AS_OUT_IF_ALT0,
438*4882a593Smuzhiyun 	STR_AS_OUT_IF_ALT1,
439*4882a593Smuzhiyun 	STR_AS_IN_IF_ALT0,
440*4882a593Smuzhiyun 	STR_AS_IN_IF_ALT1,
441*4882a593Smuzhiyun };
442*4882a593Smuzhiyun 
443*4882a593Smuzhiyun static struct usb_string strings_uac1[] = {
444*4882a593Smuzhiyun 	/* [STR_ASSOC].s = DYNAMIC, */
445*4882a593Smuzhiyun 	[STR_AC_IF].s = "AC Interface",
446*4882a593Smuzhiyun 	[STR_USB_OUT_IT].s = "Playback Input terminal",
447*4882a593Smuzhiyun 	[STR_USB_OUT_IT_CH_NAMES].s = "Playback Channels",
448*4882a593Smuzhiyun 	[STR_IO_OUT_OT].s = "Playback Output terminal",
449*4882a593Smuzhiyun 	[STR_IO_IN_IT].s = "Capture Input terminal",
450*4882a593Smuzhiyun 	[STR_IO_IN_IT_CH_NAMES].s = "Capture Channels",
451*4882a593Smuzhiyun 	[STR_USB_IN_OT].s = "Capture Output terminal",
452*4882a593Smuzhiyun 	[STR_FU_IN].s = "Capture Volume",
453*4882a593Smuzhiyun 	[STR_FU_OUT].s = "Playback Volume",
454*4882a593Smuzhiyun 	[STR_AS_OUT_IF_ALT0].s = "Playback Inactive",
455*4882a593Smuzhiyun 	[STR_AS_OUT_IF_ALT1].s = "Playback Active",
456*4882a593Smuzhiyun 	[STR_AS_IN_IF_ALT0].s = "Capture Inactive",
457*4882a593Smuzhiyun 	[STR_AS_IN_IF_ALT1].s = "Capture Active",
458*4882a593Smuzhiyun 	{ },
459*4882a593Smuzhiyun };
460*4882a593Smuzhiyun 
461*4882a593Smuzhiyun static struct usb_gadget_strings str_uac1 = {
462*4882a593Smuzhiyun 	.language = 0x0409,	/* en-us */
463*4882a593Smuzhiyun 	.strings = strings_uac1,
464*4882a593Smuzhiyun };
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun static struct usb_gadget_strings *uac1_strings[] = {
467*4882a593Smuzhiyun 	&str_uac1,
468*4882a593Smuzhiyun 	NULL,
469*4882a593Smuzhiyun };
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun /* Use macro to overcome line length limitation */
472*4882a593Smuzhiyun #define USBDHDR(p) ((struct usb_descriptor_header *)(p))
473*4882a593Smuzhiyun 
setup_headers(struct f_uac1_opts * opts,struct usb_descriptor_header ** headers,enum usb_device_speed speed)474*4882a593Smuzhiyun static void setup_headers(struct f_uac1_opts *opts,
475*4882a593Smuzhiyun 			  struct usb_descriptor_header **headers,
476*4882a593Smuzhiyun 			  enum usb_device_speed speed)
477*4882a593Smuzhiyun {
478*4882a593Smuzhiyun 	struct usb_ss_ep_comp_descriptor *epout_desc_comp = NULL;
479*4882a593Smuzhiyun 	struct usb_ss_ep_comp_descriptor *epin_desc_comp = NULL;
480*4882a593Smuzhiyun 	struct usb_ss_ep_comp_descriptor *ep_int_desc_comp = NULL;
481*4882a593Smuzhiyun 	struct usb_endpoint_descriptor *epout_desc;
482*4882a593Smuzhiyun 	struct usb_endpoint_descriptor *epin_desc;
483*4882a593Smuzhiyun 	struct usb_endpoint_descriptor *ep_int_desc;
484*4882a593Smuzhiyun 	int i;
485*4882a593Smuzhiyun 
486*4882a593Smuzhiyun 	switch (speed) {
487*4882a593Smuzhiyun 	case USB_SPEED_FULL:
488*4882a593Smuzhiyun 		epout_desc = &fs_out_ep_desc;
489*4882a593Smuzhiyun 		epin_desc = &fs_in_ep_desc;
490*4882a593Smuzhiyun 		ep_int_desc = &fs_int_ep_desc;
491*4882a593Smuzhiyun 		break;
492*4882a593Smuzhiyun 	case USB_SPEED_HIGH:
493*4882a593Smuzhiyun 		epout_desc = &as_out_ep_desc;
494*4882a593Smuzhiyun 		epin_desc = &as_in_ep_desc;
495*4882a593Smuzhiyun 		ep_int_desc = &ac_int_ep_desc;
496*4882a593Smuzhiyun 		break;
497*4882a593Smuzhiyun 	default:
498*4882a593Smuzhiyun 		epout_desc = &as_out_ep_desc;
499*4882a593Smuzhiyun 		epout_desc_comp = &as_out_ep_desc_comp;
500*4882a593Smuzhiyun 		epin_desc = &as_in_ep_desc;
501*4882a593Smuzhiyun 		epin_desc_comp = &as_in_ep_desc_comp;
502*4882a593Smuzhiyun 		ep_int_desc = &ac_int_ep_desc;
503*4882a593Smuzhiyun 		ep_int_desc_comp = &ac_int_ep_desc_comp;
504*4882a593Smuzhiyun 		break;
505*4882a593Smuzhiyun 	}
506*4882a593Smuzhiyun 
507*4882a593Smuzhiyun 	i = 0;
508*4882a593Smuzhiyun 	headers[i++] = USBDHDR(&iad_desc);
509*4882a593Smuzhiyun 	headers[i++] = USBDHDR(&ac_interface_desc);
510*4882a593Smuzhiyun 	headers[i++] = USBDHDR(ac_header_desc);
511*4882a593Smuzhiyun 
512*4882a593Smuzhiyun 	if (EPOUT_EN(opts)) {
513*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&usb_out_it_desc);
514*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&io_out_ot_desc);
515*4882a593Smuzhiyun 		if (FUOUT_EN(opts))
516*4882a593Smuzhiyun 			headers[i++] = USBDHDR(out_feature_unit_desc);
517*4882a593Smuzhiyun 	}
518*4882a593Smuzhiyun 
519*4882a593Smuzhiyun 	if (EPIN_EN(opts)) {
520*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&io_in_it_desc);
521*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&usb_in_ot_desc);
522*4882a593Smuzhiyun 		if (FUIN_EN(opts))
523*4882a593Smuzhiyun 			headers[i++] = USBDHDR(in_feature_unit_desc);
524*4882a593Smuzhiyun 	}
525*4882a593Smuzhiyun 
526*4882a593Smuzhiyun 	if (FUOUT_EN(opts) || FUIN_EN(opts)) {
527*4882a593Smuzhiyun 		headers[i++] = USBDHDR(ep_int_desc);
528*4882a593Smuzhiyun 		if (ep_int_desc_comp)
529*4882a593Smuzhiyun 			headers[i++] = USBDHDR(ep_int_desc_comp);
530*4882a593Smuzhiyun 	}
531*4882a593Smuzhiyun 
532*4882a593Smuzhiyun 	if (EPOUT_EN(opts)) {
533*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&as_out_interface_alt_0_desc);
534*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&as_out_interface_alt_1_desc);
535*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&as_out_header_desc);
536*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&as_out_type_i_desc);
537*4882a593Smuzhiyun 		headers[i++] = USBDHDR(epout_desc);
538*4882a593Smuzhiyun 		if (epout_desc_comp)
539*4882a593Smuzhiyun 			headers[i++] = USBDHDR(epout_desc_comp);
540*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&as_iso_out_desc);
541*4882a593Smuzhiyun 	}
542*4882a593Smuzhiyun 	if (EPIN_EN(opts)) {
543*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&as_in_interface_alt_0_desc);
544*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&as_in_interface_alt_1_desc);
545*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&as_in_header_desc);
546*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&as_in_type_i_desc);
547*4882a593Smuzhiyun 		headers[i++] = USBDHDR(epin_desc);
548*4882a593Smuzhiyun 		if (epin_desc_comp)
549*4882a593Smuzhiyun 			headers[i++] = USBDHDR(epin_desc_comp);
550*4882a593Smuzhiyun 		headers[i++] = USBDHDR(&as_iso_in_desc);
551*4882a593Smuzhiyun 	}
552*4882a593Smuzhiyun 	headers[i] = NULL;
553*4882a593Smuzhiyun }
554*4882a593Smuzhiyun 
555*4882a593Smuzhiyun /*
556*4882a593Smuzhiyun  * This function is an ALSA sound card following USB Audio Class Spec 1.0.
557*4882a593Smuzhiyun  */
558*4882a593Smuzhiyun 
uac_cs_attr_sample_rate(struct usb_ep * ep,struct usb_request * req)559*4882a593Smuzhiyun static void uac_cs_attr_sample_rate(struct usb_ep *ep, struct usb_request *req)
560*4882a593Smuzhiyun {
561*4882a593Smuzhiyun 	struct usb_function *fn = ep->driver_data;
562*4882a593Smuzhiyun 	struct usb_composite_dev *cdev = fn->config->cdev;
563*4882a593Smuzhiyun 	struct g_audio *agdev = func_to_g_audio(fn);
564*4882a593Smuzhiyun 	struct f_uac1 *uac1 = func_to_uac1(fn);
565*4882a593Smuzhiyun 	struct f_uac1_opts *opts = g_audio_to_uac1_opts(agdev);
566*4882a593Smuzhiyun 	u8 *buf = (u8 *)req->buf;
567*4882a593Smuzhiyun 	u32 val = 0;
568*4882a593Smuzhiyun 
569*4882a593Smuzhiyun 	if (req->actual != 3) {
570*4882a593Smuzhiyun 		WARN(cdev, "Invalid data size for UAC_EP_CS_ATTR_SAMPLE_RATE.\n");
571*4882a593Smuzhiyun 		return;
572*4882a593Smuzhiyun 	}
573*4882a593Smuzhiyun 
574*4882a593Smuzhiyun 	val = buf[0] | (buf[1] << 8) | (buf[2] << 16);
575*4882a593Smuzhiyun 	if (EPIN_EN(opts) && uac1->ctl_id == agdev->in_ep->address) {
576*4882a593Smuzhiyun 		uac1->p_srate = val;
577*4882a593Smuzhiyun 		u_audio_set_playback_srate(agdev, uac1->p_srate);
578*4882a593Smuzhiyun 	} else if (EPOUT_EN(opts) && uac1->ctl_id == agdev->out_ep->address) {
579*4882a593Smuzhiyun 		uac1->c_srate = val;
580*4882a593Smuzhiyun 		u_audio_set_capture_srate(agdev, uac1->c_srate);
581*4882a593Smuzhiyun 	}
582*4882a593Smuzhiyun }
583*4882a593Smuzhiyun 
audio_notify_complete(struct usb_ep * _ep,struct usb_request * req)584*4882a593Smuzhiyun static void audio_notify_complete(struct usb_ep *_ep, struct usb_request *req)
585*4882a593Smuzhiyun {
586*4882a593Smuzhiyun 	struct g_audio *audio = req->context;
587*4882a593Smuzhiyun 	struct f_uac1 *uac1 = func_to_uac1(&audio->func);
588*4882a593Smuzhiyun 
589*4882a593Smuzhiyun 	atomic_dec(&uac1->int_count);
590*4882a593Smuzhiyun 	kfree(req->buf);
591*4882a593Smuzhiyun 	usb_ep_free_request(_ep, req);
592*4882a593Smuzhiyun }
593*4882a593Smuzhiyun 
audio_notify(struct g_audio * audio,int unit_id,int cs)594*4882a593Smuzhiyun static int audio_notify(struct g_audio *audio, int unit_id, int cs)
595*4882a593Smuzhiyun {
596*4882a593Smuzhiyun 	struct f_uac1 *uac1 = func_to_uac1(&audio->func);
597*4882a593Smuzhiyun 	struct usb_request *req;
598*4882a593Smuzhiyun 	struct uac1_status_word *msg;
599*4882a593Smuzhiyun 	int ret;
600*4882a593Smuzhiyun 
601*4882a593Smuzhiyun 	if (!uac1->int_ep->enabled)
602*4882a593Smuzhiyun 		return 0;
603*4882a593Smuzhiyun 
604*4882a593Smuzhiyun 	if (atomic_inc_return(&uac1->int_count) > UAC1_DEF_INT_REQ_NUM) {
605*4882a593Smuzhiyun 		atomic_dec(&uac1->int_count);
606*4882a593Smuzhiyun 		return 0;
607*4882a593Smuzhiyun 	}
608*4882a593Smuzhiyun 
609*4882a593Smuzhiyun 	req = usb_ep_alloc_request(uac1->int_ep, GFP_ATOMIC);
610*4882a593Smuzhiyun 	if (req == NULL) {
611*4882a593Smuzhiyun 		ret = -ENOMEM;
612*4882a593Smuzhiyun 		goto err_dec_int_count;
613*4882a593Smuzhiyun 	}
614*4882a593Smuzhiyun 
615*4882a593Smuzhiyun 	msg = kmalloc(sizeof(*msg), GFP_ATOMIC);
616*4882a593Smuzhiyun 	if (msg == NULL) {
617*4882a593Smuzhiyun 		ret = -ENOMEM;
618*4882a593Smuzhiyun 		goto err_free_request;
619*4882a593Smuzhiyun 	}
620*4882a593Smuzhiyun 
621*4882a593Smuzhiyun 	msg->bStatusType = UAC1_STATUS_TYPE_IRQ_PENDING
622*4882a593Smuzhiyun 				| UAC1_STATUS_TYPE_ORIG_AUDIO_CONTROL_IF;
623*4882a593Smuzhiyun 	msg->bOriginator = unit_id;
624*4882a593Smuzhiyun 
625*4882a593Smuzhiyun 	req->length = sizeof(*msg);
626*4882a593Smuzhiyun 	req->buf = msg;
627*4882a593Smuzhiyun 	req->context = audio;
628*4882a593Smuzhiyun 	req->complete = audio_notify_complete;
629*4882a593Smuzhiyun 
630*4882a593Smuzhiyun 	ret = usb_ep_queue(uac1->int_ep, req, GFP_ATOMIC);
631*4882a593Smuzhiyun 
632*4882a593Smuzhiyun 	if (ret)
633*4882a593Smuzhiyun 		goto err_free_msg;
634*4882a593Smuzhiyun 
635*4882a593Smuzhiyun 	return 0;
636*4882a593Smuzhiyun 
637*4882a593Smuzhiyun err_free_msg:
638*4882a593Smuzhiyun 	kfree(msg);
639*4882a593Smuzhiyun err_free_request:
640*4882a593Smuzhiyun 	usb_ep_free_request(uac1->int_ep, req);
641*4882a593Smuzhiyun err_dec_int_count:
642*4882a593Smuzhiyun 	atomic_dec(&uac1->int_count);
643*4882a593Smuzhiyun 
644*4882a593Smuzhiyun 	return ret;
645*4882a593Smuzhiyun }
646*4882a593Smuzhiyun 
647*4882a593Smuzhiyun static int
in_rq_cur(struct usb_function * fn,const struct usb_ctrlrequest * cr)648*4882a593Smuzhiyun in_rq_cur(struct usb_function *fn, const struct usb_ctrlrequest *cr)
649*4882a593Smuzhiyun {
650*4882a593Smuzhiyun 	struct usb_request *req = fn->config->cdev->req;
651*4882a593Smuzhiyun 	struct g_audio *audio = func_to_g_audio(fn);
652*4882a593Smuzhiyun 	struct f_uac1_opts *opts = g_audio_to_uac1_opts(audio);
653*4882a593Smuzhiyun 	u16 w_length = le16_to_cpu(cr->wLength);
654*4882a593Smuzhiyun 	u16 w_index = le16_to_cpu(cr->wIndex);
655*4882a593Smuzhiyun 	u16 w_value = le16_to_cpu(cr->wValue);
656*4882a593Smuzhiyun 	u8 entity_id = (w_index >> 8) & 0xff;
657*4882a593Smuzhiyun 	u8 control_selector = w_value >> 8;
658*4882a593Smuzhiyun 	int value = -EOPNOTSUPP;
659*4882a593Smuzhiyun 
660*4882a593Smuzhiyun 	if ((FUIN_EN(opts) && (entity_id == USB_IN_FU_ID)) ||
661*4882a593Smuzhiyun 			(FUOUT_EN(opts) && (entity_id == USB_OUT_FU_ID))) {
662*4882a593Smuzhiyun 		unsigned int is_playback = 0;
663*4882a593Smuzhiyun 
664*4882a593Smuzhiyun 		if (FUIN_EN(opts) && (entity_id == USB_IN_FU_ID))
665*4882a593Smuzhiyun 			is_playback = 1;
666*4882a593Smuzhiyun 
667*4882a593Smuzhiyun 		if (control_selector == UAC_FU_MUTE) {
668*4882a593Smuzhiyun 			unsigned int mute;
669*4882a593Smuzhiyun 
670*4882a593Smuzhiyun 			u_audio_get_mute(audio, is_playback, &mute);
671*4882a593Smuzhiyun 
672*4882a593Smuzhiyun 			*(u8 *)req->buf = mute;
673*4882a593Smuzhiyun 			value = min_t(unsigned int, w_length, 1);
674*4882a593Smuzhiyun 		} else if (control_selector == UAC_FU_VOLUME) {
675*4882a593Smuzhiyun 			__le16 c;
676*4882a593Smuzhiyun 			s16 volume;
677*4882a593Smuzhiyun 
678*4882a593Smuzhiyun 			u_audio_get_volume(audio, is_playback, &volume);
679*4882a593Smuzhiyun 
680*4882a593Smuzhiyun 			c = cpu_to_le16(volume);
681*4882a593Smuzhiyun 
682*4882a593Smuzhiyun 			value = min_t(unsigned int, w_length, sizeof(c));
683*4882a593Smuzhiyun 			memcpy(req->buf, &c, value);
684*4882a593Smuzhiyun 		} else {
685*4882a593Smuzhiyun 			dev_err(&audio->gadget->dev,
686*4882a593Smuzhiyun 				"%s:%d control_selector=%d TODO!\n",
687*4882a593Smuzhiyun 				__func__, __LINE__, control_selector);
688*4882a593Smuzhiyun 		}
689*4882a593Smuzhiyun 	} else {
690*4882a593Smuzhiyun 		dev_err(&audio->gadget->dev,
691*4882a593Smuzhiyun 			"%s:%d entity_id=%d control_selector=%d TODO!\n",
692*4882a593Smuzhiyun 			__func__, __LINE__, entity_id, control_selector);
693*4882a593Smuzhiyun 	}
694*4882a593Smuzhiyun 
695*4882a593Smuzhiyun 	return value;
696*4882a593Smuzhiyun }
697*4882a593Smuzhiyun 
698*4882a593Smuzhiyun static int
in_rq_min(struct usb_function * fn,const struct usb_ctrlrequest * cr)699*4882a593Smuzhiyun in_rq_min(struct usb_function *fn, const struct usb_ctrlrequest *cr)
700*4882a593Smuzhiyun {
701*4882a593Smuzhiyun 	struct usb_request *req = fn->config->cdev->req;
702*4882a593Smuzhiyun 	struct g_audio *audio = func_to_g_audio(fn);
703*4882a593Smuzhiyun 	struct f_uac1_opts *opts = g_audio_to_uac1_opts(audio);
704*4882a593Smuzhiyun 	u16 w_length = le16_to_cpu(cr->wLength);
705*4882a593Smuzhiyun 	u16 w_index = le16_to_cpu(cr->wIndex);
706*4882a593Smuzhiyun 	u16 w_value = le16_to_cpu(cr->wValue);
707*4882a593Smuzhiyun 	u8 entity_id = (w_index >> 8) & 0xff;
708*4882a593Smuzhiyun 	u8 control_selector = w_value >> 8;
709*4882a593Smuzhiyun 	int value = -EOPNOTSUPP;
710*4882a593Smuzhiyun 
711*4882a593Smuzhiyun 	if ((FUIN_EN(opts) && (entity_id == USB_IN_FU_ID)) ||
712*4882a593Smuzhiyun 			(FUOUT_EN(opts) && (entity_id == USB_OUT_FU_ID))) {
713*4882a593Smuzhiyun 		unsigned int is_playback = 0;
714*4882a593Smuzhiyun 
715*4882a593Smuzhiyun 		if (FUIN_EN(opts) && (entity_id == USB_IN_FU_ID))
716*4882a593Smuzhiyun 			is_playback = 1;
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 		if (control_selector == UAC_FU_VOLUME) {
719*4882a593Smuzhiyun 			__le16 r;
720*4882a593Smuzhiyun 			s16 min_db;
721*4882a593Smuzhiyun 
722*4882a593Smuzhiyun 			if (is_playback)
723*4882a593Smuzhiyun 				min_db = opts->p_volume_min;
724*4882a593Smuzhiyun 			else
725*4882a593Smuzhiyun 				min_db = opts->c_volume_min;
726*4882a593Smuzhiyun 
727*4882a593Smuzhiyun 			r = cpu_to_le16(min_db);
728*4882a593Smuzhiyun 
729*4882a593Smuzhiyun 			value = min_t(unsigned int, w_length, sizeof(r));
730*4882a593Smuzhiyun 			memcpy(req->buf, &r, value);
731*4882a593Smuzhiyun 		} else {
732*4882a593Smuzhiyun 			dev_err(&audio->gadget->dev,
733*4882a593Smuzhiyun 				"%s:%d control_selector=%d TODO!\n",
734*4882a593Smuzhiyun 				__func__, __LINE__, control_selector);
735*4882a593Smuzhiyun 		}
736*4882a593Smuzhiyun 	} else {
737*4882a593Smuzhiyun 		dev_err(&audio->gadget->dev,
738*4882a593Smuzhiyun 			"%s:%d entity_id=%d control_selector=%d TODO!\n",
739*4882a593Smuzhiyun 			__func__, __LINE__, entity_id, control_selector);
740*4882a593Smuzhiyun 	}
741*4882a593Smuzhiyun 
742*4882a593Smuzhiyun 	return value;
743*4882a593Smuzhiyun }
744*4882a593Smuzhiyun 
745*4882a593Smuzhiyun static int
in_rq_max(struct usb_function * fn,const struct usb_ctrlrequest * cr)746*4882a593Smuzhiyun in_rq_max(struct usb_function *fn, const struct usb_ctrlrequest *cr)
747*4882a593Smuzhiyun {
748*4882a593Smuzhiyun 	struct usb_request *req = fn->config->cdev->req;
749*4882a593Smuzhiyun 	struct g_audio *audio = func_to_g_audio(fn);
750*4882a593Smuzhiyun 	struct f_uac1_opts *opts = g_audio_to_uac1_opts(audio);
751*4882a593Smuzhiyun 	u16 w_length = le16_to_cpu(cr->wLength);
752*4882a593Smuzhiyun 	u16 w_index = le16_to_cpu(cr->wIndex);
753*4882a593Smuzhiyun 	u16 w_value = le16_to_cpu(cr->wValue);
754*4882a593Smuzhiyun 	u8 entity_id = (w_index >> 8) & 0xff;
755*4882a593Smuzhiyun 	u8 control_selector = w_value >> 8;
756*4882a593Smuzhiyun 	int value = -EOPNOTSUPP;
757*4882a593Smuzhiyun 
758*4882a593Smuzhiyun 	if ((FUIN_EN(opts) && (entity_id == USB_IN_FU_ID)) ||
759*4882a593Smuzhiyun 			(FUOUT_EN(opts) && (entity_id == USB_OUT_FU_ID))) {
760*4882a593Smuzhiyun 		unsigned int is_playback = 0;
761*4882a593Smuzhiyun 
762*4882a593Smuzhiyun 		if (FUIN_EN(opts) && (entity_id == USB_IN_FU_ID))
763*4882a593Smuzhiyun 			is_playback = 1;
764*4882a593Smuzhiyun 
765*4882a593Smuzhiyun 		if (control_selector == UAC_FU_VOLUME) {
766*4882a593Smuzhiyun 			__le16 r;
767*4882a593Smuzhiyun 			s16 max_db;
768*4882a593Smuzhiyun 
769*4882a593Smuzhiyun 			if (is_playback)
770*4882a593Smuzhiyun 				max_db = opts->p_volume_max;
771*4882a593Smuzhiyun 			else
772*4882a593Smuzhiyun 				max_db = opts->c_volume_max;
773*4882a593Smuzhiyun 
774*4882a593Smuzhiyun 			r = cpu_to_le16(max_db);
775*4882a593Smuzhiyun 
776*4882a593Smuzhiyun 			value = min_t(unsigned int, w_length, sizeof(r));
777*4882a593Smuzhiyun 			memcpy(req->buf, &r, value);
778*4882a593Smuzhiyun 		} else {
779*4882a593Smuzhiyun 			dev_err(&audio->gadget->dev,
780*4882a593Smuzhiyun 				"%s:%d control_selector=%d TODO!\n",
781*4882a593Smuzhiyun 				__func__, __LINE__, control_selector);
782*4882a593Smuzhiyun 		}
783*4882a593Smuzhiyun 	} else {
784*4882a593Smuzhiyun 		dev_err(&audio->gadget->dev,
785*4882a593Smuzhiyun 			"%s:%d entity_id=%d control_selector=%d TODO!\n",
786*4882a593Smuzhiyun 			__func__, __LINE__, entity_id, control_selector);
787*4882a593Smuzhiyun 	}
788*4882a593Smuzhiyun 
789*4882a593Smuzhiyun 	return value;
790*4882a593Smuzhiyun }
791*4882a593Smuzhiyun 
792*4882a593Smuzhiyun static int
in_rq_res(struct usb_function * fn,const struct usb_ctrlrequest * cr)793*4882a593Smuzhiyun in_rq_res(struct usb_function *fn, const struct usb_ctrlrequest *cr)
794*4882a593Smuzhiyun {
795*4882a593Smuzhiyun 	struct usb_request *req = fn->config->cdev->req;
796*4882a593Smuzhiyun 	struct g_audio *audio = func_to_g_audio(fn);
797*4882a593Smuzhiyun 	struct f_uac1_opts *opts = g_audio_to_uac1_opts(audio);
798*4882a593Smuzhiyun 	u16 w_length = le16_to_cpu(cr->wLength);
799*4882a593Smuzhiyun 	u16 w_index = le16_to_cpu(cr->wIndex);
800*4882a593Smuzhiyun 	u16 w_value = le16_to_cpu(cr->wValue);
801*4882a593Smuzhiyun 	u8 entity_id = (w_index >> 8) & 0xff;
802*4882a593Smuzhiyun 	u8 control_selector = w_value >> 8;
803*4882a593Smuzhiyun 	int value = -EOPNOTSUPP;
804*4882a593Smuzhiyun 
805*4882a593Smuzhiyun 	if ((FUIN_EN(opts) && (entity_id == USB_IN_FU_ID)) ||
806*4882a593Smuzhiyun 			(FUOUT_EN(opts) && (entity_id == USB_OUT_FU_ID))) {
807*4882a593Smuzhiyun 		unsigned int is_playback = 0;
808*4882a593Smuzhiyun 
809*4882a593Smuzhiyun 		if (FUIN_EN(opts) && (entity_id == USB_IN_FU_ID))
810*4882a593Smuzhiyun 			is_playback = 1;
811*4882a593Smuzhiyun 
812*4882a593Smuzhiyun 		if (control_selector == UAC_FU_VOLUME) {
813*4882a593Smuzhiyun 			__le16 r;
814*4882a593Smuzhiyun 			s16 res_db;
815*4882a593Smuzhiyun 
816*4882a593Smuzhiyun 			if (is_playback)
817*4882a593Smuzhiyun 				res_db = opts->p_volume_res;
818*4882a593Smuzhiyun 			else
819*4882a593Smuzhiyun 				res_db = opts->c_volume_res;
820*4882a593Smuzhiyun 
821*4882a593Smuzhiyun 			r = cpu_to_le16(res_db);
822*4882a593Smuzhiyun 
823*4882a593Smuzhiyun 			value = min_t(unsigned int, w_length, sizeof(r));
824*4882a593Smuzhiyun 			memcpy(req->buf, &r, value);
825*4882a593Smuzhiyun 		} else {
826*4882a593Smuzhiyun 			dev_err(&audio->gadget->dev,
827*4882a593Smuzhiyun 				"%s:%d control_selector=%d TODO!\n",
828*4882a593Smuzhiyun 				__func__, __LINE__, control_selector);
829*4882a593Smuzhiyun 		}
830*4882a593Smuzhiyun 	} else {
831*4882a593Smuzhiyun 		dev_err(&audio->gadget->dev,
832*4882a593Smuzhiyun 			"%s:%d entity_id=%d control_selector=%d TODO!\n",
833*4882a593Smuzhiyun 			__func__, __LINE__, entity_id, control_selector);
834*4882a593Smuzhiyun 	}
835*4882a593Smuzhiyun 
836*4882a593Smuzhiyun 	return value;
837*4882a593Smuzhiyun }
838*4882a593Smuzhiyun 
839*4882a593Smuzhiyun static void
out_rq_complete(struct usb_ep * ep,struct usb_request * req)840*4882a593Smuzhiyun out_rq_complete(struct usb_ep *ep, struct usb_request *req)
841*4882a593Smuzhiyun {
842*4882a593Smuzhiyun 	struct g_audio *audio = req->context;
843*4882a593Smuzhiyun 	struct usb_composite_dev *cdev = audio->func.config->cdev;
844*4882a593Smuzhiyun 	struct f_uac1_opts *opts = g_audio_to_uac1_opts(audio);
845*4882a593Smuzhiyun 	struct f_uac1 *uac1 = func_to_uac1(&audio->func);
846*4882a593Smuzhiyun 	struct usb_ctrlrequest *cr = &uac1->setup_cr;
847*4882a593Smuzhiyun 	u16 w_index = le16_to_cpu(cr->wIndex);
848*4882a593Smuzhiyun 	u16 w_value = le16_to_cpu(cr->wValue);
849*4882a593Smuzhiyun 	u8 entity_id = (w_index >> 8) & 0xff;
850*4882a593Smuzhiyun 	u8 control_selector = w_value >> 8;
851*4882a593Smuzhiyun 
852*4882a593Smuzhiyun 	if (req->status != 0) {
853*4882a593Smuzhiyun 		dev_dbg(&cdev->gadget->dev, "completion err %d\n", req->status);
854*4882a593Smuzhiyun 		return;
855*4882a593Smuzhiyun 	}
856*4882a593Smuzhiyun 
857*4882a593Smuzhiyun 	if ((FUIN_EN(opts) && (entity_id == USB_IN_FU_ID)) ||
858*4882a593Smuzhiyun 			(FUOUT_EN(opts) && (entity_id == USB_OUT_FU_ID))) {
859*4882a593Smuzhiyun 		unsigned int is_playback = 0;
860*4882a593Smuzhiyun 
861*4882a593Smuzhiyun 		if (FUIN_EN(opts) && (entity_id == USB_IN_FU_ID))
862*4882a593Smuzhiyun 			is_playback = 1;
863*4882a593Smuzhiyun 
864*4882a593Smuzhiyun 		if (control_selector == UAC_FU_MUTE) {
865*4882a593Smuzhiyun 			if (cr->bRequest == UAC_SET_CUR) {
866*4882a593Smuzhiyun 				u8 mute = *(u8 *)req->buf;
867*4882a593Smuzhiyun 
868*4882a593Smuzhiyun 				u_audio_set_mute(audio, is_playback, mute);
869*4882a593Smuzhiyun 			}
870*4882a593Smuzhiyun 
871*4882a593Smuzhiyun 			return;
872*4882a593Smuzhiyun 		} else if (control_selector == UAC_FU_VOLUME) {
873*4882a593Smuzhiyun 			__le16 *c = req->buf;
874*4882a593Smuzhiyun 			s16 volume;
875*4882a593Smuzhiyun 
876*4882a593Smuzhiyun 			volume = le16_to_cpu(*c);
877*4882a593Smuzhiyun 
878*4882a593Smuzhiyun 			switch (cr->bRequest) {
879*4882a593Smuzhiyun 			case UAC_SET_CUR:
880*4882a593Smuzhiyun 				u_audio_set_volume(audio, is_playback, volume);
881*4882a593Smuzhiyun 				break;
882*4882a593Smuzhiyun 			case UAC_SET_MIN:
883*4882a593Smuzhiyun 				if (is_playback)
884*4882a593Smuzhiyun 					opts->p_volume_min = volume;
885*4882a593Smuzhiyun 				else
886*4882a593Smuzhiyun 					opts->c_volume_min = volume;
887*4882a593Smuzhiyun 				break;
888*4882a593Smuzhiyun 			case UAC_SET_MAX:
889*4882a593Smuzhiyun 				if (is_playback)
890*4882a593Smuzhiyun 					opts->p_volume_max = volume;
891*4882a593Smuzhiyun 				else
892*4882a593Smuzhiyun 					opts->c_volume_max = volume;
893*4882a593Smuzhiyun 				break;
894*4882a593Smuzhiyun 			case UAC_SET_RES:
895*4882a593Smuzhiyun 				if (is_playback)
896*4882a593Smuzhiyun 					opts->p_volume_res = volume;
897*4882a593Smuzhiyun 				else
898*4882a593Smuzhiyun 					opts->c_volume_res = volume;
899*4882a593Smuzhiyun 				break;
900*4882a593Smuzhiyun 			case UAC_SET_MEM:
901*4882a593Smuzhiyun 				break;
902*4882a593Smuzhiyun 			default:
903*4882a593Smuzhiyun 				break;
904*4882a593Smuzhiyun 			}
905*4882a593Smuzhiyun 
906*4882a593Smuzhiyun 			return;
907*4882a593Smuzhiyun 		} else {
908*4882a593Smuzhiyun 			dev_err(&audio->gadget->dev,
909*4882a593Smuzhiyun 				"%s:%d control_selector=%d TODO!\n",
910*4882a593Smuzhiyun 				__func__, __LINE__, control_selector);
911*4882a593Smuzhiyun 			usb_ep_set_halt(ep);
912*4882a593Smuzhiyun 		}
913*4882a593Smuzhiyun 	} else {
914*4882a593Smuzhiyun 		dev_err(&audio->gadget->dev,
915*4882a593Smuzhiyun 			"%s:%d entity_id=%d control_selector=%d TODO!\n",
916*4882a593Smuzhiyun 			__func__, __LINE__, entity_id, control_selector);
917*4882a593Smuzhiyun 		usb_ep_set_halt(ep);
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 	}
920*4882a593Smuzhiyun }
921*4882a593Smuzhiyun 
922*4882a593Smuzhiyun static int
ac_rq_out(struct usb_function * fn,const struct usb_ctrlrequest * cr)923*4882a593Smuzhiyun ac_rq_out(struct usb_function *fn, const struct usb_ctrlrequest *cr)
924*4882a593Smuzhiyun {
925*4882a593Smuzhiyun 	struct usb_request *req = fn->config->cdev->req;
926*4882a593Smuzhiyun 	struct g_audio *audio = func_to_g_audio(fn);
927*4882a593Smuzhiyun 	struct f_uac1_opts *opts = g_audio_to_uac1_opts(audio);
928*4882a593Smuzhiyun 	struct f_uac1 *uac1 = func_to_uac1(&audio->func);
929*4882a593Smuzhiyun 	u16 w_length = le16_to_cpu(cr->wLength);
930*4882a593Smuzhiyun 	u16 w_index = le16_to_cpu(cr->wIndex);
931*4882a593Smuzhiyun 	u16 w_value = le16_to_cpu(cr->wValue);
932*4882a593Smuzhiyun 	u8 entity_id = (w_index >> 8) & 0xff;
933*4882a593Smuzhiyun 	u8 control_selector = w_value >> 8;
934*4882a593Smuzhiyun 
935*4882a593Smuzhiyun 	if ((FUIN_EN(opts) && (entity_id == USB_IN_FU_ID)) ||
936*4882a593Smuzhiyun 			(FUOUT_EN(opts) && (entity_id == USB_OUT_FU_ID))) {
937*4882a593Smuzhiyun 		memcpy(&uac1->setup_cr, cr, sizeof(*cr));
938*4882a593Smuzhiyun 		req->context = audio;
939*4882a593Smuzhiyun 		req->complete = out_rq_complete;
940*4882a593Smuzhiyun 
941*4882a593Smuzhiyun 		return w_length;
942*4882a593Smuzhiyun 	} else {
943*4882a593Smuzhiyun 		dev_err(&audio->gadget->dev,
944*4882a593Smuzhiyun 			"%s:%d entity_id=%d control_selector=%d TODO!\n",
945*4882a593Smuzhiyun 			__func__, __LINE__, entity_id, control_selector);
946*4882a593Smuzhiyun 	}
947*4882a593Smuzhiyun 	return -EOPNOTSUPP;
948*4882a593Smuzhiyun }
949*4882a593Smuzhiyun 
ac_rq_in(struct usb_function * f,const struct usb_ctrlrequest * ctrl)950*4882a593Smuzhiyun static int ac_rq_in(struct usb_function *f,
951*4882a593Smuzhiyun 		const struct usb_ctrlrequest *ctrl)
952*4882a593Smuzhiyun {
953*4882a593Smuzhiyun 	struct usb_composite_dev *cdev = f->config->cdev;
954*4882a593Smuzhiyun 	int value = -EOPNOTSUPP;
955*4882a593Smuzhiyun 	u8 ep = ((le16_to_cpu(ctrl->wIndex) >> 8) & 0xFF);
956*4882a593Smuzhiyun 	u16 len = le16_to_cpu(ctrl->wLength);
957*4882a593Smuzhiyun 	u16 w_value = le16_to_cpu(ctrl->wValue);
958*4882a593Smuzhiyun 
959*4882a593Smuzhiyun 	DBG(cdev, "bRequest 0x%x, w_value 0x%04x, len %d, endpoint %d\n",
960*4882a593Smuzhiyun 			ctrl->bRequest, w_value, len, ep);
961*4882a593Smuzhiyun 
962*4882a593Smuzhiyun 	switch (ctrl->bRequest) {
963*4882a593Smuzhiyun 	case UAC_GET_CUR:
964*4882a593Smuzhiyun 		return in_rq_cur(f, ctrl);
965*4882a593Smuzhiyun 	case UAC_GET_MIN:
966*4882a593Smuzhiyun 		return in_rq_min(f, ctrl);
967*4882a593Smuzhiyun 	case UAC_GET_MAX:
968*4882a593Smuzhiyun 		return in_rq_max(f, ctrl);
969*4882a593Smuzhiyun 	case UAC_GET_RES:
970*4882a593Smuzhiyun 		return in_rq_res(f, ctrl);
971*4882a593Smuzhiyun 	case UAC_GET_MEM:
972*4882a593Smuzhiyun 		break;
973*4882a593Smuzhiyun 	case UAC_GET_STAT:
974*4882a593Smuzhiyun 		value = len;
975*4882a593Smuzhiyun 		break;
976*4882a593Smuzhiyun 	default:
977*4882a593Smuzhiyun 		break;
978*4882a593Smuzhiyun 	}
979*4882a593Smuzhiyun 
980*4882a593Smuzhiyun 	return value;
981*4882a593Smuzhiyun }
982*4882a593Smuzhiyun 
audio_set_endpoint_req(struct usb_function * f,const struct usb_ctrlrequest * ctrl)983*4882a593Smuzhiyun static int audio_set_endpoint_req(struct usb_function *f,
984*4882a593Smuzhiyun 		const struct usb_ctrlrequest *ctrl)
985*4882a593Smuzhiyun {
986*4882a593Smuzhiyun 	struct usb_composite_dev *cdev = f->config->cdev;
987*4882a593Smuzhiyun 	struct usb_request	*req = f->config->cdev->req;
988*4882a593Smuzhiyun 	struct f_uac1		*uac1 = func_to_uac1(f);
989*4882a593Smuzhiyun 	int			value = -EOPNOTSUPP;
990*4882a593Smuzhiyun 	u16			ep = le16_to_cpu(ctrl->wIndex);
991*4882a593Smuzhiyun 	u16			len = le16_to_cpu(ctrl->wLength);
992*4882a593Smuzhiyun 	u16			w_value = le16_to_cpu(ctrl->wValue);
993*4882a593Smuzhiyun 	u8			cs = w_value >> 8;
994*4882a593Smuzhiyun 
995*4882a593Smuzhiyun 	DBG(cdev, "bRequest 0x%x, w_value 0x%04x, len %d, endpoint %d\n",
996*4882a593Smuzhiyun 			ctrl->bRequest, w_value, len, ep);
997*4882a593Smuzhiyun 
998*4882a593Smuzhiyun 	switch (ctrl->bRequest) {
999*4882a593Smuzhiyun 	case UAC_SET_CUR: {
1000*4882a593Smuzhiyun 		if (cs == UAC_EP_CS_ATTR_SAMPLE_RATE) {
1001*4882a593Smuzhiyun 			cdev->gadget->ep0->driver_data = f;
1002*4882a593Smuzhiyun 			uac1->ctl_id = ep;
1003*4882a593Smuzhiyun 			req->complete = uac_cs_attr_sample_rate;
1004*4882a593Smuzhiyun 		}
1005*4882a593Smuzhiyun 		value = len;
1006*4882a593Smuzhiyun 		break;
1007*4882a593Smuzhiyun 	}
1008*4882a593Smuzhiyun 
1009*4882a593Smuzhiyun 	case UAC_SET_MIN:
1010*4882a593Smuzhiyun 		break;
1011*4882a593Smuzhiyun 
1012*4882a593Smuzhiyun 	case UAC_SET_MAX:
1013*4882a593Smuzhiyun 		break;
1014*4882a593Smuzhiyun 
1015*4882a593Smuzhiyun 	case UAC_SET_RES:
1016*4882a593Smuzhiyun 		break;
1017*4882a593Smuzhiyun 
1018*4882a593Smuzhiyun 	case UAC_SET_MEM:
1019*4882a593Smuzhiyun 		break;
1020*4882a593Smuzhiyun 
1021*4882a593Smuzhiyun 	default:
1022*4882a593Smuzhiyun 		break;
1023*4882a593Smuzhiyun 	}
1024*4882a593Smuzhiyun 
1025*4882a593Smuzhiyun 	return value;
1026*4882a593Smuzhiyun }
1027*4882a593Smuzhiyun 
audio_get_endpoint_req(struct usb_function * f,const struct usb_ctrlrequest * ctrl)1028*4882a593Smuzhiyun static int audio_get_endpoint_req(struct usb_function *f,
1029*4882a593Smuzhiyun 		const struct usb_ctrlrequest *ctrl)
1030*4882a593Smuzhiyun {
1031*4882a593Smuzhiyun 	struct usb_composite_dev *cdev = f->config->cdev;
1032*4882a593Smuzhiyun 	struct usb_request *req = f->config->cdev->req;
1033*4882a593Smuzhiyun 	struct f_uac1 *uac1 = func_to_uac1(f);
1034*4882a593Smuzhiyun 	struct g_audio *agdev = func_to_g_audio(f);
1035*4882a593Smuzhiyun 	struct f_uac1_opts *opts = g_audio_to_uac1_opts(agdev);
1036*4882a593Smuzhiyun 	u8 *buf = (u8 *)req->buf;
1037*4882a593Smuzhiyun 	int value = -EOPNOTSUPP;
1038*4882a593Smuzhiyun 	u8 ep = le16_to_cpu(ctrl->wIndex);
1039*4882a593Smuzhiyun 	u16 len = le16_to_cpu(ctrl->wLength);
1040*4882a593Smuzhiyun 	u16 w_value = le16_to_cpu(ctrl->wValue);
1041*4882a593Smuzhiyun 	u8 cs = w_value >> 8;
1042*4882a593Smuzhiyun 	u32 val = 0;
1043*4882a593Smuzhiyun 
1044*4882a593Smuzhiyun 	DBG(cdev, "bRequest 0x%x, w_value 0x%04x, len %d, endpoint %d\n",
1045*4882a593Smuzhiyun 			ctrl->bRequest, w_value, len, ep);
1046*4882a593Smuzhiyun 
1047*4882a593Smuzhiyun 	switch (ctrl->bRequest) {
1048*4882a593Smuzhiyun 	case UAC_GET_CUR: {
1049*4882a593Smuzhiyun 		if (cs == UAC_EP_CS_ATTR_SAMPLE_RATE) {
1050*4882a593Smuzhiyun 			if (EPIN_EN(opts) && ep == agdev->in_ep->address)
1051*4882a593Smuzhiyun 				val = uac1->p_srate;
1052*4882a593Smuzhiyun 			else if (EPOUT_EN(opts) && ep == agdev->out_ep->address)
1053*4882a593Smuzhiyun 				val = uac1->c_srate;
1054*4882a593Smuzhiyun 			buf[2] = (val >> 16) & 0xff;
1055*4882a593Smuzhiyun 			buf[1] = (val >> 8) & 0xff;
1056*4882a593Smuzhiyun 			buf[0] = val & 0xff;
1057*4882a593Smuzhiyun 		}
1058*4882a593Smuzhiyun 		value = len;
1059*4882a593Smuzhiyun 		break;
1060*4882a593Smuzhiyun 	}
1061*4882a593Smuzhiyun 	case UAC_GET_MIN:
1062*4882a593Smuzhiyun 	case UAC_GET_MAX:
1063*4882a593Smuzhiyun 	case UAC_GET_RES:
1064*4882a593Smuzhiyun 		value = len;
1065*4882a593Smuzhiyun 		break;
1066*4882a593Smuzhiyun 	case UAC_GET_MEM:
1067*4882a593Smuzhiyun 		break;
1068*4882a593Smuzhiyun 	default:
1069*4882a593Smuzhiyun 		break;
1070*4882a593Smuzhiyun 	}
1071*4882a593Smuzhiyun 
1072*4882a593Smuzhiyun 	return value;
1073*4882a593Smuzhiyun }
1074*4882a593Smuzhiyun 
1075*4882a593Smuzhiyun static int
f_audio_setup(struct usb_function * f,const struct usb_ctrlrequest * ctrl)1076*4882a593Smuzhiyun f_audio_setup(struct usb_function *f, const struct usb_ctrlrequest *ctrl)
1077*4882a593Smuzhiyun {
1078*4882a593Smuzhiyun 	struct usb_composite_dev *cdev = f->config->cdev;
1079*4882a593Smuzhiyun 	struct usb_request	*req = cdev->req;
1080*4882a593Smuzhiyun 	int			value = -EOPNOTSUPP;
1081*4882a593Smuzhiyun 	u16			w_index = le16_to_cpu(ctrl->wIndex);
1082*4882a593Smuzhiyun 	u16			w_value = le16_to_cpu(ctrl->wValue);
1083*4882a593Smuzhiyun 	u16			w_length = le16_to_cpu(ctrl->wLength);
1084*4882a593Smuzhiyun 
1085*4882a593Smuzhiyun 	/* composite driver infrastructure handles everything; interface
1086*4882a593Smuzhiyun 	 * activation uses set_alt().
1087*4882a593Smuzhiyun 	 */
1088*4882a593Smuzhiyun 	switch (ctrl->bRequestType) {
1089*4882a593Smuzhiyun 	case USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_ENDPOINT:
1090*4882a593Smuzhiyun 		value = audio_set_endpoint_req(f, ctrl);
1091*4882a593Smuzhiyun 		break;
1092*4882a593Smuzhiyun 
1093*4882a593Smuzhiyun 	case USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_ENDPOINT:
1094*4882a593Smuzhiyun 		value = audio_get_endpoint_req(f, ctrl);
1095*4882a593Smuzhiyun 		break;
1096*4882a593Smuzhiyun 	case USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE:
1097*4882a593Smuzhiyun 		value = ac_rq_out(f, ctrl);
1098*4882a593Smuzhiyun 		break;
1099*4882a593Smuzhiyun 	case USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE:
1100*4882a593Smuzhiyun 		value = ac_rq_in(f, ctrl);
1101*4882a593Smuzhiyun 		break;
1102*4882a593Smuzhiyun 	default:
1103*4882a593Smuzhiyun 		ERROR(cdev, "invalid control req%02x.%02x v%04x i%04x l%d\n",
1104*4882a593Smuzhiyun 			ctrl->bRequestType, ctrl->bRequest,
1105*4882a593Smuzhiyun 			w_value, w_index, w_length);
1106*4882a593Smuzhiyun 	}
1107*4882a593Smuzhiyun 
1108*4882a593Smuzhiyun 	/* respond with data transfer or status phase? */
1109*4882a593Smuzhiyun 	if (value >= 0) {
1110*4882a593Smuzhiyun 		DBG(cdev, "audio req%02x.%02x v%04x i%04x l%d\n",
1111*4882a593Smuzhiyun 			ctrl->bRequestType, ctrl->bRequest,
1112*4882a593Smuzhiyun 			w_value, w_index, w_length);
1113*4882a593Smuzhiyun 		req->zero = 0;
1114*4882a593Smuzhiyun 		req->length = value;
1115*4882a593Smuzhiyun 		value = usb_ep_queue(cdev->gadget->ep0, req, GFP_ATOMIC);
1116*4882a593Smuzhiyun 		if (value < 0)
1117*4882a593Smuzhiyun 			ERROR(cdev, "audio response on err %d\n", value);
1118*4882a593Smuzhiyun 	}
1119*4882a593Smuzhiyun 
1120*4882a593Smuzhiyun 	/* device either stalls (value < 0) or reports success */
1121*4882a593Smuzhiyun 	return value;
1122*4882a593Smuzhiyun }
1123*4882a593Smuzhiyun 
f_audio_set_alt(struct usb_function * f,unsigned intf,unsigned alt)1124*4882a593Smuzhiyun static int f_audio_set_alt(struct usb_function *f, unsigned intf, unsigned alt)
1125*4882a593Smuzhiyun {
1126*4882a593Smuzhiyun 	struct usb_composite_dev *cdev = f->config->cdev;
1127*4882a593Smuzhiyun 	struct usb_gadget *gadget = cdev->gadget;
1128*4882a593Smuzhiyun 	struct device *dev = &gadget->dev;
1129*4882a593Smuzhiyun 	struct g_audio *audio = func_to_g_audio(f);
1130*4882a593Smuzhiyun 	struct f_uac1 *uac1 = func_to_uac1(f);
1131*4882a593Smuzhiyun 	int ret = 0;
1132*4882a593Smuzhiyun 
1133*4882a593Smuzhiyun 	/* No i/f has more than 2 alt settings */
1134*4882a593Smuzhiyun 	if (alt > 1) {
1135*4882a593Smuzhiyun 		dev_err(dev, "%s:%d Error!\n", __func__, __LINE__);
1136*4882a593Smuzhiyun 		return -EINVAL;
1137*4882a593Smuzhiyun 	}
1138*4882a593Smuzhiyun 
1139*4882a593Smuzhiyun 	if (intf == uac1->ac_intf) {
1140*4882a593Smuzhiyun 		/* Control I/f has only 1 AltSetting - 0 */
1141*4882a593Smuzhiyun 		if (alt) {
1142*4882a593Smuzhiyun 			dev_err(dev, "%s:%d Error!\n", __func__, __LINE__);
1143*4882a593Smuzhiyun 			return -EINVAL;
1144*4882a593Smuzhiyun 		}
1145*4882a593Smuzhiyun 
1146*4882a593Smuzhiyun 		/* restart interrupt endpoint */
1147*4882a593Smuzhiyun 		if (uac1->int_ep) {
1148*4882a593Smuzhiyun 			usb_ep_disable(uac1->int_ep);
1149*4882a593Smuzhiyun 			config_ep_by_speed(gadget, &audio->func, uac1->int_ep);
1150*4882a593Smuzhiyun 			usb_ep_enable(uac1->int_ep);
1151*4882a593Smuzhiyun 		}
1152*4882a593Smuzhiyun 
1153*4882a593Smuzhiyun 		return 0;
1154*4882a593Smuzhiyun 	}
1155*4882a593Smuzhiyun 
1156*4882a593Smuzhiyun 	if (intf == uac1->as_out_intf) {
1157*4882a593Smuzhiyun 		uac1->as_out_alt = alt;
1158*4882a593Smuzhiyun 
1159*4882a593Smuzhiyun 		if (alt)
1160*4882a593Smuzhiyun 			ret = u_audio_start_capture(&uac1->g_audio);
1161*4882a593Smuzhiyun 		else
1162*4882a593Smuzhiyun 			u_audio_stop_capture(&uac1->g_audio);
1163*4882a593Smuzhiyun 	} else if (intf == uac1->as_in_intf) {
1164*4882a593Smuzhiyun 		uac1->as_in_alt = alt;
1165*4882a593Smuzhiyun 
1166*4882a593Smuzhiyun 		if (alt)
1167*4882a593Smuzhiyun 			ret = u_audio_start_playback(&uac1->g_audio);
1168*4882a593Smuzhiyun 		else
1169*4882a593Smuzhiyun 			u_audio_stop_playback(&uac1->g_audio);
1170*4882a593Smuzhiyun 	} else {
1171*4882a593Smuzhiyun 		dev_err(dev, "%s:%d Error!\n", __func__, __LINE__);
1172*4882a593Smuzhiyun 		return -EINVAL;
1173*4882a593Smuzhiyun 	}
1174*4882a593Smuzhiyun 
1175*4882a593Smuzhiyun 	return ret;
1176*4882a593Smuzhiyun }
1177*4882a593Smuzhiyun 
f_audio_get_alt(struct usb_function * f,unsigned intf)1178*4882a593Smuzhiyun static int f_audio_get_alt(struct usb_function *f, unsigned intf)
1179*4882a593Smuzhiyun {
1180*4882a593Smuzhiyun 	struct usb_composite_dev *cdev = f->config->cdev;
1181*4882a593Smuzhiyun 	struct usb_gadget *gadget = cdev->gadget;
1182*4882a593Smuzhiyun 	struct device *dev = &gadget->dev;
1183*4882a593Smuzhiyun 	struct f_uac1 *uac1 = func_to_uac1(f);
1184*4882a593Smuzhiyun 
1185*4882a593Smuzhiyun 	if (intf == uac1->ac_intf)
1186*4882a593Smuzhiyun 		return uac1->ac_alt;
1187*4882a593Smuzhiyun 	else if (intf == uac1->as_out_intf)
1188*4882a593Smuzhiyun 		return uac1->as_out_alt;
1189*4882a593Smuzhiyun 	else if (intf == uac1->as_in_intf)
1190*4882a593Smuzhiyun 		return uac1->as_in_alt;
1191*4882a593Smuzhiyun 	else
1192*4882a593Smuzhiyun 		dev_err(dev, "%s:%d Invalid Interface %d!\n",
1193*4882a593Smuzhiyun 			__func__, __LINE__, intf);
1194*4882a593Smuzhiyun 
1195*4882a593Smuzhiyun 	return -EINVAL;
1196*4882a593Smuzhiyun }
1197*4882a593Smuzhiyun 
1198*4882a593Smuzhiyun 
f_audio_disable(struct usb_function * f)1199*4882a593Smuzhiyun static void f_audio_disable(struct usb_function *f)
1200*4882a593Smuzhiyun {
1201*4882a593Smuzhiyun 	struct f_uac1 *uac1 = func_to_uac1(f);
1202*4882a593Smuzhiyun 
1203*4882a593Smuzhiyun 	uac1->as_out_alt = 0;
1204*4882a593Smuzhiyun 	uac1->as_in_alt = 0;
1205*4882a593Smuzhiyun 
1206*4882a593Smuzhiyun 	u_audio_stop_playback(&uac1->g_audio);
1207*4882a593Smuzhiyun 	u_audio_stop_capture(&uac1->g_audio);
1208*4882a593Smuzhiyun 	if (uac1->int_ep)
1209*4882a593Smuzhiyun 		usb_ep_disable(uac1->int_ep);
1210*4882a593Smuzhiyun }
1211*4882a593Smuzhiyun 
1212*4882a593Smuzhiyun static void
f_audio_suspend(struct usb_function * f)1213*4882a593Smuzhiyun f_audio_suspend(struct usb_function *f)
1214*4882a593Smuzhiyun {
1215*4882a593Smuzhiyun 	struct f_uac1 *uac1 = func_to_uac1(f);
1216*4882a593Smuzhiyun 
1217*4882a593Smuzhiyun 	u_audio_suspend(&uac1->g_audio);
1218*4882a593Smuzhiyun }
1219*4882a593Smuzhiyun 
1220*4882a593Smuzhiyun /*-------------------------------------------------------------------------*/
build_fu_desc(int chmask)1221*4882a593Smuzhiyun static struct uac_feature_unit_descriptor *build_fu_desc(int chmask)
1222*4882a593Smuzhiyun {
1223*4882a593Smuzhiyun 	struct uac_feature_unit_descriptor *fu_desc;
1224*4882a593Smuzhiyun 	int channels = num_channels(chmask);
1225*4882a593Smuzhiyun 	int fu_desc_size = UAC_DT_FEATURE_UNIT_SIZE(channels);
1226*4882a593Smuzhiyun 
1227*4882a593Smuzhiyun 	fu_desc = kzalloc(fu_desc_size, GFP_KERNEL);
1228*4882a593Smuzhiyun 	if (!fu_desc)
1229*4882a593Smuzhiyun 		return NULL;
1230*4882a593Smuzhiyun 
1231*4882a593Smuzhiyun 	fu_desc->bLength = fu_desc_size;
1232*4882a593Smuzhiyun 	fu_desc->bDescriptorType = USB_DT_CS_INTERFACE;
1233*4882a593Smuzhiyun 
1234*4882a593Smuzhiyun 	fu_desc->bDescriptorSubtype = UAC_FEATURE_UNIT;
1235*4882a593Smuzhiyun 	fu_desc->bControlSize  = 2;
1236*4882a593Smuzhiyun 
1237*4882a593Smuzhiyun 	/* bUnitID, bSourceID and bmaControls will be defined later */
1238*4882a593Smuzhiyun 
1239*4882a593Smuzhiyun 	return fu_desc;
1240*4882a593Smuzhiyun }
1241*4882a593Smuzhiyun 
1242*4882a593Smuzhiyun /* B.3.2  Class-Specific AC Interface Descriptor */
1243*4882a593Smuzhiyun static struct
build_ac_header_desc(struct f_uac1_opts * opts)1244*4882a593Smuzhiyun uac1_ac_header_descriptor *build_ac_header_desc(struct f_uac1_opts *opts)
1245*4882a593Smuzhiyun {
1246*4882a593Smuzhiyun 	struct uac1_ac_header_descriptor *ac_desc;
1247*4882a593Smuzhiyun 	int ac_header_desc_size;
1248*4882a593Smuzhiyun 	int num_ifaces = 0;
1249*4882a593Smuzhiyun 
1250*4882a593Smuzhiyun 	if (EPOUT_EN(opts))
1251*4882a593Smuzhiyun 		num_ifaces++;
1252*4882a593Smuzhiyun 	if (EPIN_EN(opts))
1253*4882a593Smuzhiyun 		num_ifaces++;
1254*4882a593Smuzhiyun 
1255*4882a593Smuzhiyun 	ac_header_desc_size = UAC_DT_AC_HEADER_SIZE(num_ifaces);
1256*4882a593Smuzhiyun 
1257*4882a593Smuzhiyun 	ac_desc = kzalloc(ac_header_desc_size, GFP_KERNEL);
1258*4882a593Smuzhiyun 	if (!ac_desc)
1259*4882a593Smuzhiyun 		return NULL;
1260*4882a593Smuzhiyun 
1261*4882a593Smuzhiyun 	ac_desc->bLength = ac_header_desc_size;
1262*4882a593Smuzhiyun 	ac_desc->bDescriptorType = USB_DT_CS_INTERFACE;
1263*4882a593Smuzhiyun 	ac_desc->bDescriptorSubtype = UAC_HEADER;
1264*4882a593Smuzhiyun 	ac_desc->bcdADC = cpu_to_le16(0x0100);
1265*4882a593Smuzhiyun 	ac_desc->bInCollection = num_ifaces;
1266*4882a593Smuzhiyun 
1267*4882a593Smuzhiyun 	/* wTotalLength and baInterfaceNr will be defined later */
1268*4882a593Smuzhiyun 
1269*4882a593Smuzhiyun 	return ac_desc;
1270*4882a593Smuzhiyun }
1271*4882a593Smuzhiyun 
setup_descriptor(struct f_uac1_opts * opts)1272*4882a593Smuzhiyun static void setup_descriptor(struct f_uac1_opts *opts)
1273*4882a593Smuzhiyun {
1274*4882a593Smuzhiyun 	/* patch descriptors */
1275*4882a593Smuzhiyun 	int i = 1; /* ID's start with 1 */
1276*4882a593Smuzhiyun 
1277*4882a593Smuzhiyun 	if (EPOUT_EN(opts))
1278*4882a593Smuzhiyun 		usb_out_it_desc.bTerminalID = i++;
1279*4882a593Smuzhiyun 	if (EPIN_EN(opts))
1280*4882a593Smuzhiyun 		io_in_it_desc.bTerminalID = i++;
1281*4882a593Smuzhiyun 	if (EPOUT_EN(opts))
1282*4882a593Smuzhiyun 		io_out_ot_desc.bTerminalID = i++;
1283*4882a593Smuzhiyun 	if (EPIN_EN(opts))
1284*4882a593Smuzhiyun 		usb_in_ot_desc.bTerminalID = i++;
1285*4882a593Smuzhiyun 	if (FUOUT_EN(opts))
1286*4882a593Smuzhiyun 		out_feature_unit_desc->bUnitID = i++;
1287*4882a593Smuzhiyun 	if (FUIN_EN(opts))
1288*4882a593Smuzhiyun 		in_feature_unit_desc->bUnitID = i++;
1289*4882a593Smuzhiyun 
1290*4882a593Smuzhiyun 	if (FUIN_EN(opts)) {
1291*4882a593Smuzhiyun 		usb_in_ot_desc.bSourceID = in_feature_unit_desc->bUnitID;
1292*4882a593Smuzhiyun 		in_feature_unit_desc->bSourceID = io_in_it_desc.bTerminalID;
1293*4882a593Smuzhiyun 	} else {
1294*4882a593Smuzhiyun 		usb_in_ot_desc.bSourceID = io_in_it_desc.bTerminalID;
1295*4882a593Smuzhiyun 	}
1296*4882a593Smuzhiyun 	if (FUOUT_EN(opts)) {
1297*4882a593Smuzhiyun 		io_out_ot_desc.bSourceID = out_feature_unit_desc->bUnitID;
1298*4882a593Smuzhiyun 		out_feature_unit_desc->bSourceID = usb_out_it_desc.bTerminalID;
1299*4882a593Smuzhiyun 	} else {
1300*4882a593Smuzhiyun 		io_out_ot_desc.bSourceID = usb_out_it_desc.bTerminalID;
1301*4882a593Smuzhiyun 	}
1302*4882a593Smuzhiyun 
1303*4882a593Smuzhiyun 	as_out_header_desc.bTerminalLink = usb_out_it_desc.bTerminalID;
1304*4882a593Smuzhiyun 	as_in_header_desc.bTerminalLink = usb_in_ot_desc.bTerminalID;
1305*4882a593Smuzhiyun 
1306*4882a593Smuzhiyun 	iad_desc.bInterfaceCount = 1;
1307*4882a593Smuzhiyun 	ac_header_desc->wTotalLength = cpu_to_le16(ac_header_desc->bLength);
1308*4882a593Smuzhiyun 
1309*4882a593Smuzhiyun 	if (EPIN_EN(opts)) {
1310*4882a593Smuzhiyun 		u16 len = le16_to_cpu(ac_header_desc->wTotalLength);
1311*4882a593Smuzhiyun 
1312*4882a593Smuzhiyun 		len += sizeof(usb_in_ot_desc);
1313*4882a593Smuzhiyun 		len += sizeof(io_in_it_desc);
1314*4882a593Smuzhiyun 		if (FUIN_EN(opts))
1315*4882a593Smuzhiyun 			len += in_feature_unit_desc->bLength;
1316*4882a593Smuzhiyun 		ac_header_desc->wTotalLength = cpu_to_le16(len);
1317*4882a593Smuzhiyun 		iad_desc.bInterfaceCount++;
1318*4882a593Smuzhiyun 	}
1319*4882a593Smuzhiyun 	if (EPOUT_EN(opts)) {
1320*4882a593Smuzhiyun 		u16 len = le16_to_cpu(ac_header_desc->wTotalLength);
1321*4882a593Smuzhiyun 
1322*4882a593Smuzhiyun 		len += sizeof(usb_out_it_desc);
1323*4882a593Smuzhiyun 		len += sizeof(io_out_ot_desc);
1324*4882a593Smuzhiyun 		if (FUOUT_EN(opts))
1325*4882a593Smuzhiyun 			len += out_feature_unit_desc->bLength;
1326*4882a593Smuzhiyun 		ac_header_desc->wTotalLength = cpu_to_le16(len);
1327*4882a593Smuzhiyun 		iad_desc.bInterfaceCount++;
1328*4882a593Smuzhiyun 	}
1329*4882a593Smuzhiyun 
1330*4882a593Smuzhiyun 	setup_headers(opts, fs_audio_desc, USB_SPEED_FULL);
1331*4882a593Smuzhiyun 	setup_headers(opts, hs_audio_desc, USB_SPEED_HIGH);
1332*4882a593Smuzhiyun 	setup_headers(opts, ss_audio_desc, USB_SPEED_SUPER);
1333*4882a593Smuzhiyun }
1334*4882a593Smuzhiyun 
f_audio_validate_opts(struct g_audio * audio,struct device * dev)1335*4882a593Smuzhiyun static int f_audio_validate_opts(struct g_audio *audio, struct device *dev)
1336*4882a593Smuzhiyun {
1337*4882a593Smuzhiyun 	struct f_uac1_opts *opts = g_audio_to_uac1_opts(audio);
1338*4882a593Smuzhiyun 
1339*4882a593Smuzhiyun 	if (!opts->p_chmask && !opts->c_chmask) {
1340*4882a593Smuzhiyun 		dev_err(dev, "Error: no playback and capture channels\n");
1341*4882a593Smuzhiyun 		return -EINVAL;
1342*4882a593Smuzhiyun 	} else if (opts->p_chmask & ~UAC1_CHANNEL_MASK) {
1343*4882a593Smuzhiyun 		dev_err(dev, "Error: unsupported playback channels mask\n");
1344*4882a593Smuzhiyun 		return -EINVAL;
1345*4882a593Smuzhiyun 	} else if (opts->c_chmask & ~UAC1_CHANNEL_MASK) {
1346*4882a593Smuzhiyun 		dev_err(dev, "Error: unsupported capture channels mask\n");
1347*4882a593Smuzhiyun 		return -EINVAL;
1348*4882a593Smuzhiyun 	} else if ((opts->p_ssize < 1) || (opts->p_ssize > 4)) {
1349*4882a593Smuzhiyun 		dev_err(dev, "Error: incorrect playback sample size\n");
1350*4882a593Smuzhiyun 		return -EINVAL;
1351*4882a593Smuzhiyun 	} else if ((opts->c_ssize < 1) || (opts->c_ssize > 4)) {
1352*4882a593Smuzhiyun 		dev_err(dev, "Error: incorrect capture sample size\n");
1353*4882a593Smuzhiyun 		return -EINVAL;
1354*4882a593Smuzhiyun 	} else if (!opts->p_srates[0]) {
1355*4882a593Smuzhiyun 		dev_err(dev, "Error: incorrect playback sampling rate\n");
1356*4882a593Smuzhiyun 		return -EINVAL;
1357*4882a593Smuzhiyun 	} else if (!opts->c_srates[0]) {
1358*4882a593Smuzhiyun 		dev_err(dev, "Error: incorrect capture sampling rate\n");
1359*4882a593Smuzhiyun 		return -EINVAL;
1360*4882a593Smuzhiyun 	}
1361*4882a593Smuzhiyun 
1362*4882a593Smuzhiyun 	if (opts->p_volume_max <= opts->p_volume_min) {
1363*4882a593Smuzhiyun 		dev_err(dev, "Error: incorrect playback volume max/min\n");
1364*4882a593Smuzhiyun 		return -EINVAL;
1365*4882a593Smuzhiyun 	} else if (opts->c_volume_max <= opts->c_volume_min) {
1366*4882a593Smuzhiyun 		dev_err(dev, "Error: incorrect capture volume max/min\n");
1367*4882a593Smuzhiyun 		return -EINVAL;
1368*4882a593Smuzhiyun 	} else if (opts->p_volume_res <= 0) {
1369*4882a593Smuzhiyun 		dev_err(dev, "Error: negative/zero playback volume resolution\n");
1370*4882a593Smuzhiyun 		return -EINVAL;
1371*4882a593Smuzhiyun 	} else if (opts->c_volume_res <= 0) {
1372*4882a593Smuzhiyun 		dev_err(dev, "Error: negative/zero capture volume resolution\n");
1373*4882a593Smuzhiyun 		return -EINVAL;
1374*4882a593Smuzhiyun 	}
1375*4882a593Smuzhiyun 
1376*4882a593Smuzhiyun 	if ((opts->p_volume_max - opts->p_volume_min) % opts->p_volume_res) {
1377*4882a593Smuzhiyun 		dev_err(dev, "Error: incorrect playback volume resolution\n");
1378*4882a593Smuzhiyun 		return -EINVAL;
1379*4882a593Smuzhiyun 	} else if ((opts->c_volume_max - opts->c_volume_min) % opts->c_volume_res) {
1380*4882a593Smuzhiyun 		dev_err(dev, "Error: incorrect capture volume resolution\n");
1381*4882a593Smuzhiyun 		return -EINVAL;
1382*4882a593Smuzhiyun 	}
1383*4882a593Smuzhiyun 
1384*4882a593Smuzhiyun 	return 0;
1385*4882a593Smuzhiyun }
1386*4882a593Smuzhiyun 
set_ep_max_packet_size(const struct f_uac1_opts * opts,struct usb_endpoint_descriptor * ep_desc,enum usb_device_speed speed,bool is_playback)1387*4882a593Smuzhiyun static int set_ep_max_packet_size(const struct f_uac1_opts *opts,
1388*4882a593Smuzhiyun 				  struct usb_endpoint_descriptor *ep_desc,
1389*4882a593Smuzhiyun 				  enum usb_device_speed speed, bool is_playback)
1390*4882a593Smuzhiyun {
1391*4882a593Smuzhiyun 	int chmask, srate = 0, ssize;
1392*4882a593Smuzhiyun 	u16 max_size_bw, max_size_ep;
1393*4882a593Smuzhiyun 	unsigned int factor;
1394*4882a593Smuzhiyun 	int i;
1395*4882a593Smuzhiyun 
1396*4882a593Smuzhiyun 	switch (speed) {
1397*4882a593Smuzhiyun 	case USB_SPEED_FULL:
1398*4882a593Smuzhiyun 		max_size_ep = 1023;
1399*4882a593Smuzhiyun 		factor = 1000;
1400*4882a593Smuzhiyun 		break;
1401*4882a593Smuzhiyun 
1402*4882a593Smuzhiyun 	case USB_SPEED_HIGH:
1403*4882a593Smuzhiyun 		fallthrough;
1404*4882a593Smuzhiyun 	case USB_SPEED_SUPER:
1405*4882a593Smuzhiyun 		max_size_ep = 1024;
1406*4882a593Smuzhiyun 		factor = 8000;
1407*4882a593Smuzhiyun 		break;
1408*4882a593Smuzhiyun 
1409*4882a593Smuzhiyun 	default:
1410*4882a593Smuzhiyun 		return -EINVAL;
1411*4882a593Smuzhiyun 	}
1412*4882a593Smuzhiyun 
1413*4882a593Smuzhiyun 	if (is_playback) {
1414*4882a593Smuzhiyun 		chmask = opts->p_chmask;
1415*4882a593Smuzhiyun 		for (i = 0; i < UAC_MAX_RATES; i++) {
1416*4882a593Smuzhiyun 			if (opts->p_srates[i] == 0)
1417*4882a593Smuzhiyun 				break;
1418*4882a593Smuzhiyun 			if (opts->p_srates[i] > srate)
1419*4882a593Smuzhiyun 				srate = opts->p_srates[i];
1420*4882a593Smuzhiyun 		}
1421*4882a593Smuzhiyun 		ssize = opts->p_ssize;
1422*4882a593Smuzhiyun 	} else {
1423*4882a593Smuzhiyun 		chmask = opts->c_chmask;
1424*4882a593Smuzhiyun 		for (i = 0; i < UAC_MAX_RATES; i++) {
1425*4882a593Smuzhiyun 			if (opts->c_srates[i] == 0)
1426*4882a593Smuzhiyun 				break;
1427*4882a593Smuzhiyun 			if (opts->c_srates[i] > srate)
1428*4882a593Smuzhiyun 				srate = opts->c_srates[i];
1429*4882a593Smuzhiyun 		}
1430*4882a593Smuzhiyun 		ssize = opts->c_ssize;
1431*4882a593Smuzhiyun 	}
1432*4882a593Smuzhiyun 
1433*4882a593Smuzhiyun 	max_size_bw = num_channels(chmask) * ssize *
1434*4882a593Smuzhiyun 		((srate / (factor / (1 << (ep_desc->bInterval - 1)))) + 1);
1435*4882a593Smuzhiyun 	ep_desc->wMaxPacketSize = cpu_to_le16(min_t(u16, max_size_bw,
1436*4882a593Smuzhiyun 						    max_size_ep));
1437*4882a593Smuzhiyun 
1438*4882a593Smuzhiyun 	return 0;
1439*4882a593Smuzhiyun }
1440*4882a593Smuzhiyun 
1441*4882a593Smuzhiyun /* audio function driver setup/binding */
f_audio_bind(struct usb_configuration * c,struct usb_function * f)1442*4882a593Smuzhiyun static int f_audio_bind(struct usb_configuration *c, struct usb_function *f)
1443*4882a593Smuzhiyun {
1444*4882a593Smuzhiyun 	struct usb_composite_dev	*cdev = c->cdev;
1445*4882a593Smuzhiyun 	struct usb_gadget		*gadget = cdev->gadget;
1446*4882a593Smuzhiyun 	struct device			*dev = &gadget->dev;
1447*4882a593Smuzhiyun 	struct f_uac1			*uac1 = func_to_uac1(f);
1448*4882a593Smuzhiyun 	struct g_audio			*audio = func_to_g_audio(f);
1449*4882a593Smuzhiyun 	struct f_uac1_opts		*audio_opts;
1450*4882a593Smuzhiyun 	struct usb_ep			*ep = NULL;
1451*4882a593Smuzhiyun 	struct usb_string		*us;
1452*4882a593Smuzhiyun 	int				ba_iface_id;
1453*4882a593Smuzhiyun 	int				status;
1454*4882a593Smuzhiyun 	int				idx, i;
1455*4882a593Smuzhiyun 
1456*4882a593Smuzhiyun 	status = f_audio_validate_opts(audio, dev);
1457*4882a593Smuzhiyun 	if (status)
1458*4882a593Smuzhiyun 		return status;
1459*4882a593Smuzhiyun 
1460*4882a593Smuzhiyun 	audio_opts = container_of(f->fi, struct f_uac1_opts, func_inst);
1461*4882a593Smuzhiyun 
1462*4882a593Smuzhiyun 	strings_uac1[STR_ASSOC].s = audio_opts->function_name;
1463*4882a593Smuzhiyun 
1464*4882a593Smuzhiyun 	us = usb_gstrings_attach(cdev, uac1_strings, ARRAY_SIZE(strings_uac1));
1465*4882a593Smuzhiyun 	if (IS_ERR(us))
1466*4882a593Smuzhiyun 		return PTR_ERR(us);
1467*4882a593Smuzhiyun 
1468*4882a593Smuzhiyun 	ac_header_desc = build_ac_header_desc(audio_opts);
1469*4882a593Smuzhiyun 	if (!ac_header_desc)
1470*4882a593Smuzhiyun 		return -ENOMEM;
1471*4882a593Smuzhiyun 
1472*4882a593Smuzhiyun 	if (FUOUT_EN(audio_opts)) {
1473*4882a593Smuzhiyun 		out_feature_unit_desc = build_fu_desc(audio_opts->c_chmask);
1474*4882a593Smuzhiyun 		if (!out_feature_unit_desc) {
1475*4882a593Smuzhiyun 			status = -ENOMEM;
1476*4882a593Smuzhiyun 			goto fail;
1477*4882a593Smuzhiyun 		}
1478*4882a593Smuzhiyun 	}
1479*4882a593Smuzhiyun 	if (FUIN_EN(audio_opts)) {
1480*4882a593Smuzhiyun 		in_feature_unit_desc = build_fu_desc(audio_opts->p_chmask);
1481*4882a593Smuzhiyun 		if (!in_feature_unit_desc) {
1482*4882a593Smuzhiyun 			status = -ENOMEM;
1483*4882a593Smuzhiyun 			goto err_free_fu;
1484*4882a593Smuzhiyun 		}
1485*4882a593Smuzhiyun 	}
1486*4882a593Smuzhiyun 
1487*4882a593Smuzhiyun 	iad_desc.iFunction = us[STR_ASSOC].id;
1488*4882a593Smuzhiyun 	ac_interface_desc.iInterface = us[STR_AC_IF].id;
1489*4882a593Smuzhiyun 	usb_out_it_desc.iTerminal = us[STR_USB_OUT_IT].id;
1490*4882a593Smuzhiyun 	usb_out_it_desc.iChannelNames = us[STR_USB_OUT_IT_CH_NAMES].id;
1491*4882a593Smuzhiyun 	io_out_ot_desc.iTerminal = us[STR_IO_OUT_OT].id;
1492*4882a593Smuzhiyun 	as_out_interface_alt_0_desc.iInterface = us[STR_AS_OUT_IF_ALT0].id;
1493*4882a593Smuzhiyun 	as_out_interface_alt_1_desc.iInterface = us[STR_AS_OUT_IF_ALT1].id;
1494*4882a593Smuzhiyun 	io_in_it_desc.iTerminal = us[STR_IO_IN_IT].id;
1495*4882a593Smuzhiyun 	io_in_it_desc.iChannelNames = us[STR_IO_IN_IT_CH_NAMES].id;
1496*4882a593Smuzhiyun 	usb_in_ot_desc.iTerminal = us[STR_USB_IN_OT].id;
1497*4882a593Smuzhiyun 	as_in_interface_alt_0_desc.iInterface = us[STR_AS_IN_IF_ALT0].id;
1498*4882a593Smuzhiyun 	as_in_interface_alt_1_desc.iInterface = us[STR_AS_IN_IF_ALT1].id;
1499*4882a593Smuzhiyun 
1500*4882a593Smuzhiyun 	if (FUOUT_EN(audio_opts)) {
1501*4882a593Smuzhiyun 		u8 *i_feature;
1502*4882a593Smuzhiyun 
1503*4882a593Smuzhiyun 		i_feature = (u8 *)out_feature_unit_desc +
1504*4882a593Smuzhiyun 					out_feature_unit_desc->bLength - 1;
1505*4882a593Smuzhiyun 		*i_feature = us[STR_FU_OUT].id;
1506*4882a593Smuzhiyun 	}
1507*4882a593Smuzhiyun 	if (FUIN_EN(audio_opts)) {
1508*4882a593Smuzhiyun 		u8 *i_feature;
1509*4882a593Smuzhiyun 
1510*4882a593Smuzhiyun 		i_feature = (u8 *)in_feature_unit_desc +
1511*4882a593Smuzhiyun 					in_feature_unit_desc->bLength - 1;
1512*4882a593Smuzhiyun 		*i_feature = us[STR_FU_IN].id;
1513*4882a593Smuzhiyun 	}
1514*4882a593Smuzhiyun 
1515*4882a593Smuzhiyun 	/* Set channel numbers */
1516*4882a593Smuzhiyun 	usb_out_it_desc.bNrChannels = num_channels(audio_opts->c_chmask);
1517*4882a593Smuzhiyun 	usb_out_it_desc.wChannelConfig = cpu_to_le16(audio_opts->c_chmask);
1518*4882a593Smuzhiyun 	as_out_type_i_desc.bNrChannels = num_channels(audio_opts->c_chmask);
1519*4882a593Smuzhiyun 	as_out_type_i_desc.bSubframeSize = audio_opts->c_ssize;
1520*4882a593Smuzhiyun 	as_out_type_i_desc.bBitResolution = audio_opts->c_ssize * 8;
1521*4882a593Smuzhiyun 	io_in_it_desc.bNrChannels = num_channels(audio_opts->p_chmask);
1522*4882a593Smuzhiyun 	io_in_it_desc.wChannelConfig = cpu_to_le16(audio_opts->p_chmask);
1523*4882a593Smuzhiyun 	as_in_type_i_desc.bNrChannels = num_channels(audio_opts->p_chmask);
1524*4882a593Smuzhiyun 	as_in_type_i_desc.bSubframeSize = audio_opts->p_ssize;
1525*4882a593Smuzhiyun 	as_in_type_i_desc.bBitResolution = audio_opts->p_ssize * 8;
1526*4882a593Smuzhiyun 
1527*4882a593Smuzhiyun 	if (FUOUT_EN(audio_opts)) {
1528*4882a593Smuzhiyun 		__le16 *bma = (__le16 *)&out_feature_unit_desc->bmaControls[0];
1529*4882a593Smuzhiyun 		u32 control = 0;
1530*4882a593Smuzhiyun 
1531*4882a593Smuzhiyun 		if (audio_opts->c_mute_present)
1532*4882a593Smuzhiyun 			control |= UAC_FU_MUTE;
1533*4882a593Smuzhiyun 		if (audio_opts->c_volume_present)
1534*4882a593Smuzhiyun 			control |= UAC_FU_VOLUME;
1535*4882a593Smuzhiyun 		*bma = cpu_to_le16(control);
1536*4882a593Smuzhiyun 	}
1537*4882a593Smuzhiyun 	if (FUIN_EN(audio_opts)) {
1538*4882a593Smuzhiyun 		__le16 *bma = (__le16 *)&in_feature_unit_desc->bmaControls[0];
1539*4882a593Smuzhiyun 		u32 control = 0;
1540*4882a593Smuzhiyun 
1541*4882a593Smuzhiyun 		if (audio_opts->p_mute_present)
1542*4882a593Smuzhiyun 			control |= UAC_FU_MUTE;
1543*4882a593Smuzhiyun 		if (audio_opts->p_volume_present)
1544*4882a593Smuzhiyun 			control |= UAC_FU_VOLUME;
1545*4882a593Smuzhiyun 		*bma = cpu_to_le16(control);
1546*4882a593Smuzhiyun 	}
1547*4882a593Smuzhiyun 
1548*4882a593Smuzhiyun 	/* Set sample rates */
1549*4882a593Smuzhiyun 	for (i = 0, idx = 0; i < UAC_MAX_RATES; i++) {
1550*4882a593Smuzhiyun 		if (audio_opts->c_srates[i] == 0)
1551*4882a593Smuzhiyun 			break;
1552*4882a593Smuzhiyun 		memcpy(as_out_type_i_desc.tSamFreq[idx++],
1553*4882a593Smuzhiyun 				&audio_opts->c_srates[i], 3);
1554*4882a593Smuzhiyun 	}
1555*4882a593Smuzhiyun 
1556*4882a593Smuzhiyun 	/*
1557*4882a593Smuzhiyun 	 * Calculate wMaxPacketSize according to audio bandwidth.
1558*4882a593Smuzhiyun 	 * Set the max packet with USB_SPEED_HIGH by default to
1559*4882a593Smuzhiyun 	 * be compatible with larger bandwidth requirements for
1560*4882a593Smuzhiyun 	 * high speed mode.
1561*4882a593Smuzhiyun 	 */
1562*4882a593Smuzhiyun 	status = set_ep_max_packet_size(audio_opts, &fs_out_ep_desc,
1563*4882a593Smuzhiyun 					USB_SPEED_FULL, false);
1564*4882a593Smuzhiyun 	if (status < 0) {
1565*4882a593Smuzhiyun 		dev_err(dev, "%s:%d Error!\n", __func__, __LINE__);
1566*4882a593Smuzhiyun 		goto fail;
1567*4882a593Smuzhiyun 	}
1568*4882a593Smuzhiyun 
1569*4882a593Smuzhiyun 	status = set_ep_max_packet_size(audio_opts, &fs_in_ep_desc,
1570*4882a593Smuzhiyun 					USB_SPEED_FULL, true);
1571*4882a593Smuzhiyun 	if (status < 0) {
1572*4882a593Smuzhiyun 		dev_err(dev, "%s:%d Error!\n", __func__, __LINE__);
1573*4882a593Smuzhiyun 		goto fail;
1574*4882a593Smuzhiyun 	}
1575*4882a593Smuzhiyun 
1576*4882a593Smuzhiyun 	status = set_ep_max_packet_size(audio_opts, &as_out_ep_desc,
1577*4882a593Smuzhiyun 					USB_SPEED_HIGH, false);
1578*4882a593Smuzhiyun 	if (status < 0) {
1579*4882a593Smuzhiyun 		dev_err(dev, "%s:%d Error!\n", __func__, __LINE__);
1580*4882a593Smuzhiyun 		goto fail;
1581*4882a593Smuzhiyun 	}
1582*4882a593Smuzhiyun 
1583*4882a593Smuzhiyun 	status = set_ep_max_packet_size(audio_opts, &as_in_ep_desc,
1584*4882a593Smuzhiyun 					USB_SPEED_HIGH, true);
1585*4882a593Smuzhiyun 	if (status < 0) {
1586*4882a593Smuzhiyun 		dev_err(dev, "%s:%d Error!\n", __func__, __LINE__);
1587*4882a593Smuzhiyun 		goto fail;
1588*4882a593Smuzhiyun 	}
1589*4882a593Smuzhiyun 
1590*4882a593Smuzhiyun 	as_out_ep_desc_comp.wBytesPerInterval = as_out_ep_desc.wMaxPacketSize;
1591*4882a593Smuzhiyun 	as_in_ep_desc_comp.wBytesPerInterval = as_in_ep_desc.wMaxPacketSize;
1592*4882a593Smuzhiyun 	as_out_type_i_desc.bLength = UAC_FORMAT_TYPE_I_DISCRETE_DESC_SIZE(idx);
1593*4882a593Smuzhiyun 	as_out_type_i_desc.bSamFreqType = idx;
1594*4882a593Smuzhiyun 
1595*4882a593Smuzhiyun 	for (i = 0, idx = 0; i < UAC_MAX_RATES; i++) {
1596*4882a593Smuzhiyun 		if (audio_opts->p_srates[i] == 0)
1597*4882a593Smuzhiyun 			break;
1598*4882a593Smuzhiyun 		memcpy(as_in_type_i_desc.tSamFreq[idx++],
1599*4882a593Smuzhiyun 				&audio_opts->p_srates[i], 3);
1600*4882a593Smuzhiyun 	}
1601*4882a593Smuzhiyun 	as_in_type_i_desc.bLength = UAC_FORMAT_TYPE_I_DISCRETE_DESC_SIZE(idx);
1602*4882a593Smuzhiyun 	as_in_type_i_desc.bSamFreqType = idx;
1603*4882a593Smuzhiyun 	uac1->p_srate = audio_opts->p_srates[0];
1604*4882a593Smuzhiyun 	uac1->c_srate = audio_opts->c_srates[0];
1605*4882a593Smuzhiyun 
1606*4882a593Smuzhiyun 	/* allocate instance-specific interface IDs, and patch descriptors */
1607*4882a593Smuzhiyun 	status = usb_interface_id(c, f);
1608*4882a593Smuzhiyun 	if (status < 0)
1609*4882a593Smuzhiyun 		goto err_free_fu;
1610*4882a593Smuzhiyun 	iad_desc.bFirstInterface = status;
1611*4882a593Smuzhiyun 	ac_interface_desc.bInterfaceNumber = status;
1612*4882a593Smuzhiyun 	uac1->ac_intf = status;
1613*4882a593Smuzhiyun 	uac1->ac_alt = 0;
1614*4882a593Smuzhiyun 
1615*4882a593Smuzhiyun 	ba_iface_id = 0;
1616*4882a593Smuzhiyun 
1617*4882a593Smuzhiyun 	if (EPOUT_EN(audio_opts)) {
1618*4882a593Smuzhiyun 		status = usb_interface_id(c, f);
1619*4882a593Smuzhiyun 		if (status < 0)
1620*4882a593Smuzhiyun 			goto err_free_fu;
1621*4882a593Smuzhiyun 		as_out_interface_alt_0_desc.bInterfaceNumber = status;
1622*4882a593Smuzhiyun 		as_out_interface_alt_1_desc.bInterfaceNumber = status;
1623*4882a593Smuzhiyun 		ac_header_desc->baInterfaceNr[ba_iface_id++] = status;
1624*4882a593Smuzhiyun 		uac1->as_out_intf = status;
1625*4882a593Smuzhiyun 		uac1->as_out_alt = 0;
1626*4882a593Smuzhiyun 	}
1627*4882a593Smuzhiyun 
1628*4882a593Smuzhiyun 	if (EPIN_EN(audio_opts)) {
1629*4882a593Smuzhiyun 		status = usb_interface_id(c, f);
1630*4882a593Smuzhiyun 		if (status < 0)
1631*4882a593Smuzhiyun 			goto err_free_fu;
1632*4882a593Smuzhiyun 		as_in_interface_alt_0_desc.bInterfaceNumber = status;
1633*4882a593Smuzhiyun 		as_in_interface_alt_1_desc.bInterfaceNumber = status;
1634*4882a593Smuzhiyun 		ac_header_desc->baInterfaceNr[ba_iface_id++] = status;
1635*4882a593Smuzhiyun 		uac1->as_in_intf = status;
1636*4882a593Smuzhiyun 		uac1->as_in_alt = 0;
1637*4882a593Smuzhiyun 	}
1638*4882a593Smuzhiyun 
1639*4882a593Smuzhiyun 	audio->gadget = gadget;
1640*4882a593Smuzhiyun 
1641*4882a593Smuzhiyun 	status = -ENODEV;
1642*4882a593Smuzhiyun 
1643*4882a593Smuzhiyun 	ac_interface_desc.bNumEndpoints = 0;
1644*4882a593Smuzhiyun 
1645*4882a593Smuzhiyun 	/* allocate AC interrupt endpoint */
1646*4882a593Smuzhiyun 	if (FUOUT_EN(audio_opts) || FUIN_EN(audio_opts)) {
1647*4882a593Smuzhiyun 		ep = usb_ep_autoconfig(cdev->gadget, &ac_int_ep_desc);
1648*4882a593Smuzhiyun 		if (!ep)
1649*4882a593Smuzhiyun 			goto err_free_fu;
1650*4882a593Smuzhiyun 		uac1->int_ep = ep;
1651*4882a593Smuzhiyun 
1652*4882a593Smuzhiyun 		ac_interface_desc.bNumEndpoints = 1;
1653*4882a593Smuzhiyun 	}
1654*4882a593Smuzhiyun 
1655*4882a593Smuzhiyun 	/* allocate instance-specific endpoints */
1656*4882a593Smuzhiyun 	if (EPOUT_EN(audio_opts)) {
1657*4882a593Smuzhiyun 		ep = usb_ep_autoconfig(cdev->gadget, &as_out_ep_desc);
1658*4882a593Smuzhiyun 		if (!ep)
1659*4882a593Smuzhiyun 			goto err_free_fu;
1660*4882a593Smuzhiyun 		audio->out_ep = ep;
1661*4882a593Smuzhiyun 	}
1662*4882a593Smuzhiyun 
1663*4882a593Smuzhiyun 	if (EPIN_EN(audio_opts)) {
1664*4882a593Smuzhiyun 		ep = usb_ep_autoconfig(cdev->gadget, &as_in_ep_desc);
1665*4882a593Smuzhiyun 		if (!ep)
1666*4882a593Smuzhiyun 			goto err_free_fu;
1667*4882a593Smuzhiyun 		audio->in_ep = ep;
1668*4882a593Smuzhiyun 	}
1669*4882a593Smuzhiyun 
1670*4882a593Smuzhiyun 	/* FS endpoint addresses are copied from autoconfigured HS descriptors */
1671*4882a593Smuzhiyun 	fs_int_ep_desc.bEndpointAddress = ac_int_ep_desc.bEndpointAddress;
1672*4882a593Smuzhiyun 	fs_out_ep_desc.bEndpointAddress = as_out_ep_desc.bEndpointAddress;
1673*4882a593Smuzhiyun 	fs_in_ep_desc.bEndpointAddress = as_in_ep_desc.bEndpointAddress;
1674*4882a593Smuzhiyun 
1675*4882a593Smuzhiyun 	setup_descriptor(audio_opts);
1676*4882a593Smuzhiyun 
1677*4882a593Smuzhiyun 	/* copy descriptors, and track endpoint copies */
1678*4882a593Smuzhiyun 	status = usb_assign_descriptors(f, fs_audio_desc, hs_audio_desc,
1679*4882a593Smuzhiyun 					ss_audio_desc, ss_audio_desc);
1680*4882a593Smuzhiyun 	if (status)
1681*4882a593Smuzhiyun 		goto err_free_fu;
1682*4882a593Smuzhiyun 
1683*4882a593Smuzhiyun 	audio->out_ep_maxpsize = max_t(u16,
1684*4882a593Smuzhiyun 				le16_to_cpu(fs_out_ep_desc.wMaxPacketSize),
1685*4882a593Smuzhiyun 				le16_to_cpu(as_out_ep_desc.wMaxPacketSize));
1686*4882a593Smuzhiyun 	audio->in_ep_maxpsize = max_t(u16,
1687*4882a593Smuzhiyun 				le16_to_cpu(fs_in_ep_desc.wMaxPacketSize),
1688*4882a593Smuzhiyun 				le16_to_cpu(as_in_ep_desc.wMaxPacketSize));
1689*4882a593Smuzhiyun 	audio->params.c_chmask = audio_opts->c_chmask;
1690*4882a593Smuzhiyun 	memcpy(audio->params.c_srates, audio_opts->c_srates,
1691*4882a593Smuzhiyun 			sizeof(audio->params.c_srates));
1692*4882a593Smuzhiyun 	audio->params.c_ssize = audio_opts->c_ssize;
1693*4882a593Smuzhiyun 	if (FUIN_EN(audio_opts)) {
1694*4882a593Smuzhiyun 		audio->params.p_fu.id = USB_IN_FU_ID;
1695*4882a593Smuzhiyun 		audio->params.p_fu.mute_present = audio_opts->p_mute_present;
1696*4882a593Smuzhiyun 		audio->params.p_fu.volume_present =
1697*4882a593Smuzhiyun 				audio_opts->p_volume_present;
1698*4882a593Smuzhiyun 		audio->params.p_fu.volume_min = audio_opts->p_volume_min;
1699*4882a593Smuzhiyun 		audio->params.p_fu.volume_max = audio_opts->p_volume_max;
1700*4882a593Smuzhiyun 		audio->params.p_fu.volume_res = audio_opts->p_volume_res;
1701*4882a593Smuzhiyun 	}
1702*4882a593Smuzhiyun 	audio->params.p_chmask = audio_opts->p_chmask;
1703*4882a593Smuzhiyun 	memcpy(audio->params.p_srates, audio_opts->p_srates,
1704*4882a593Smuzhiyun 			sizeof(audio->params.p_srates));
1705*4882a593Smuzhiyun 	audio->params.p_ssize = audio_opts->p_ssize;
1706*4882a593Smuzhiyun 	if (FUOUT_EN(audio_opts)) {
1707*4882a593Smuzhiyun 		audio->params.c_fu.id = USB_OUT_FU_ID;
1708*4882a593Smuzhiyun 		audio->params.c_fu.mute_present = audio_opts->c_mute_present;
1709*4882a593Smuzhiyun 		audio->params.c_fu.volume_present =
1710*4882a593Smuzhiyun 				audio_opts->c_volume_present;
1711*4882a593Smuzhiyun 		audio->params.c_fu.volume_min = audio_opts->c_volume_min;
1712*4882a593Smuzhiyun 		audio->params.c_fu.volume_max = audio_opts->c_volume_max;
1713*4882a593Smuzhiyun 		audio->params.c_fu.volume_res = audio_opts->c_volume_res;
1714*4882a593Smuzhiyun 	}
1715*4882a593Smuzhiyun 	audio->params.req_number = audio_opts->req_number;
1716*4882a593Smuzhiyun 	audio->params.fb_max = FBACK_FAST_MAX;
1717*4882a593Smuzhiyun 	if (FUOUT_EN(audio_opts) || FUIN_EN(audio_opts))
1718*4882a593Smuzhiyun 		audio->notify = audio_notify;
1719*4882a593Smuzhiyun 
1720*4882a593Smuzhiyun 	status = g_audio_setup(audio, "UAC1_PCM", "UAC1_Gadget");
1721*4882a593Smuzhiyun 	if (status)
1722*4882a593Smuzhiyun 		goto err_card_register;
1723*4882a593Smuzhiyun 
1724*4882a593Smuzhiyun 	return 0;
1725*4882a593Smuzhiyun 
1726*4882a593Smuzhiyun err_card_register:
1727*4882a593Smuzhiyun 	usb_free_all_descriptors(f);
1728*4882a593Smuzhiyun err_free_fu:
1729*4882a593Smuzhiyun 	kfree(out_feature_unit_desc);
1730*4882a593Smuzhiyun 	out_feature_unit_desc = NULL;
1731*4882a593Smuzhiyun 	kfree(in_feature_unit_desc);
1732*4882a593Smuzhiyun 	in_feature_unit_desc = NULL;
1733*4882a593Smuzhiyun fail:
1734*4882a593Smuzhiyun 	kfree(ac_header_desc);
1735*4882a593Smuzhiyun 	ac_header_desc = NULL;
1736*4882a593Smuzhiyun 	return status;
1737*4882a593Smuzhiyun }
1738*4882a593Smuzhiyun 
1739*4882a593Smuzhiyun /*-------------------------------------------------------------------------*/
1740*4882a593Smuzhiyun 
to_f_uac1_opts(struct config_item * item)1741*4882a593Smuzhiyun static inline struct f_uac1_opts *to_f_uac1_opts(struct config_item *item)
1742*4882a593Smuzhiyun {
1743*4882a593Smuzhiyun 	return container_of(to_config_group(item), struct f_uac1_opts,
1744*4882a593Smuzhiyun 			    func_inst.group);
1745*4882a593Smuzhiyun }
1746*4882a593Smuzhiyun 
f_uac1_attr_release(struct config_item * item)1747*4882a593Smuzhiyun static void f_uac1_attr_release(struct config_item *item)
1748*4882a593Smuzhiyun {
1749*4882a593Smuzhiyun 	struct f_uac1_opts *opts = to_f_uac1_opts(item);
1750*4882a593Smuzhiyun 
1751*4882a593Smuzhiyun 	usb_put_function_instance(&opts->func_inst);
1752*4882a593Smuzhiyun }
1753*4882a593Smuzhiyun 
1754*4882a593Smuzhiyun static struct configfs_item_operations f_uac1_item_ops = {
1755*4882a593Smuzhiyun 	.release	= f_uac1_attr_release,
1756*4882a593Smuzhiyun };
1757*4882a593Smuzhiyun 
1758*4882a593Smuzhiyun #define uac1_kstrtou32			kstrtou32
1759*4882a593Smuzhiyun #define uac1_kstrtos16			kstrtos16
1760*4882a593Smuzhiyun #define uac1_kstrtobool(s, base, res)	kstrtobool((s), (res))
1761*4882a593Smuzhiyun 
1762*4882a593Smuzhiyun static const char *u32_fmt = "%u\n";
1763*4882a593Smuzhiyun static const char *s16_fmt = "%hd\n";
1764*4882a593Smuzhiyun static const char *bool_fmt = "%u\n";
1765*4882a593Smuzhiyun 
1766*4882a593Smuzhiyun #define UAC1_ATTRIBUTE(type, name)					\
1767*4882a593Smuzhiyun static ssize_t f_uac1_opts_##name##_show(				\
1768*4882a593Smuzhiyun 					  struct config_item *item,	\
1769*4882a593Smuzhiyun 					  char *page)			\
1770*4882a593Smuzhiyun {									\
1771*4882a593Smuzhiyun 	struct f_uac1_opts *opts = to_f_uac1_opts(item);		\
1772*4882a593Smuzhiyun 	int result;							\
1773*4882a593Smuzhiyun 									\
1774*4882a593Smuzhiyun 	mutex_lock(&opts->lock);					\
1775*4882a593Smuzhiyun 	result = sprintf(page, type##_fmt, opts->name);			\
1776*4882a593Smuzhiyun 	mutex_unlock(&opts->lock);					\
1777*4882a593Smuzhiyun 									\
1778*4882a593Smuzhiyun 	return result;							\
1779*4882a593Smuzhiyun }									\
1780*4882a593Smuzhiyun 									\
1781*4882a593Smuzhiyun static ssize_t f_uac1_opts_##name##_store(				\
1782*4882a593Smuzhiyun 					  struct config_item *item,	\
1783*4882a593Smuzhiyun 					  const char *page, size_t len)	\
1784*4882a593Smuzhiyun {									\
1785*4882a593Smuzhiyun 	struct f_uac1_opts *opts = to_f_uac1_opts(item);		\
1786*4882a593Smuzhiyun 	int ret;							\
1787*4882a593Smuzhiyun 	type num;							\
1788*4882a593Smuzhiyun 									\
1789*4882a593Smuzhiyun 	mutex_lock(&opts->lock);					\
1790*4882a593Smuzhiyun 	if (opts->refcnt) {						\
1791*4882a593Smuzhiyun 		ret = -EBUSY;						\
1792*4882a593Smuzhiyun 		goto end;						\
1793*4882a593Smuzhiyun 	}								\
1794*4882a593Smuzhiyun 									\
1795*4882a593Smuzhiyun 	ret = uac1_kstrto##type(page, 0, &num);				\
1796*4882a593Smuzhiyun 	if (ret)							\
1797*4882a593Smuzhiyun 		goto end;						\
1798*4882a593Smuzhiyun 									\
1799*4882a593Smuzhiyun 	opts->name = num;						\
1800*4882a593Smuzhiyun 	ret = len;							\
1801*4882a593Smuzhiyun 									\
1802*4882a593Smuzhiyun end:									\
1803*4882a593Smuzhiyun 	mutex_unlock(&opts->lock);					\
1804*4882a593Smuzhiyun 	return ret;							\
1805*4882a593Smuzhiyun }									\
1806*4882a593Smuzhiyun 									\
1807*4882a593Smuzhiyun CONFIGFS_ATTR(f_uac1_opts_, name)
1808*4882a593Smuzhiyun 
1809*4882a593Smuzhiyun #define UAC1_RATE_ATTRIBUTE(name)					\
1810*4882a593Smuzhiyun static ssize_t f_uac1_opts_##name##_show(struct config_item *item,	\
1811*4882a593Smuzhiyun 					 char *page)			\
1812*4882a593Smuzhiyun {									\
1813*4882a593Smuzhiyun 	struct f_uac1_opts *opts = to_f_uac1_opts(item);		\
1814*4882a593Smuzhiyun 	int result = 0;							\
1815*4882a593Smuzhiyun 	int i;								\
1816*4882a593Smuzhiyun 									\
1817*4882a593Smuzhiyun 	mutex_lock(&opts->lock);					\
1818*4882a593Smuzhiyun 	page[0] = '\0';							\
1819*4882a593Smuzhiyun 	for (i = 0; i < UAC_MAX_RATES; i++) {				\
1820*4882a593Smuzhiyun 		if (opts->name##s[i] == 0)				\
1821*4882a593Smuzhiyun 			break;						\
1822*4882a593Smuzhiyun 		result += sprintf(page + strlen(page), "%u,",		\
1823*4882a593Smuzhiyun 				opts->name##s[i]);			\
1824*4882a593Smuzhiyun 	}								\
1825*4882a593Smuzhiyun 	if (strlen(page) > 0)						\
1826*4882a593Smuzhiyun 		page[strlen(page) - 1] = '\n';				\
1827*4882a593Smuzhiyun 	mutex_unlock(&opts->lock);					\
1828*4882a593Smuzhiyun 									\
1829*4882a593Smuzhiyun 	return result;							\
1830*4882a593Smuzhiyun }									\
1831*4882a593Smuzhiyun 									\
1832*4882a593Smuzhiyun static ssize_t f_uac1_opts_##name##_store(struct config_item *item,	\
1833*4882a593Smuzhiyun 					  const char *page, size_t len)	\
1834*4882a593Smuzhiyun {									\
1835*4882a593Smuzhiyun 	struct f_uac1_opts *opts = to_f_uac1_opts(item);		\
1836*4882a593Smuzhiyun 	char *split_page = NULL;					\
1837*4882a593Smuzhiyun 	int ret = -EINVAL;						\
1838*4882a593Smuzhiyun 	char *token;							\
1839*4882a593Smuzhiyun 	u32 num;							\
1840*4882a593Smuzhiyun 	int i;								\
1841*4882a593Smuzhiyun 									\
1842*4882a593Smuzhiyun 	mutex_lock(&opts->lock);					\
1843*4882a593Smuzhiyun 	if (opts->refcnt) {						\
1844*4882a593Smuzhiyun 		ret = -EBUSY;						\
1845*4882a593Smuzhiyun 		goto end;						\
1846*4882a593Smuzhiyun 	}								\
1847*4882a593Smuzhiyun 									\
1848*4882a593Smuzhiyun 	i = 0;								\
1849*4882a593Smuzhiyun 	memset(opts->name##s, 0x00, sizeof(opts->name##s));		\
1850*4882a593Smuzhiyun 	split_page = kstrdup(page, GFP_KERNEL);				\
1851*4882a593Smuzhiyun 	while ((token = strsep(&split_page, ",")) != NULL) {		\
1852*4882a593Smuzhiyun 		ret = kstrtou32(token, 0, &num);			\
1853*4882a593Smuzhiyun 		if (ret)						\
1854*4882a593Smuzhiyun 			goto end;					\
1855*4882a593Smuzhiyun 									\
1856*4882a593Smuzhiyun 		opts->name##s[i++] = num;				\
1857*4882a593Smuzhiyun 		ret = len;						\
1858*4882a593Smuzhiyun 	};								\
1859*4882a593Smuzhiyun 									\
1860*4882a593Smuzhiyun end:									\
1861*4882a593Smuzhiyun 	kfree(split_page);						\
1862*4882a593Smuzhiyun 	mutex_unlock(&opts->lock);					\
1863*4882a593Smuzhiyun 	return ret;							\
1864*4882a593Smuzhiyun }									\
1865*4882a593Smuzhiyun 									\
1866*4882a593Smuzhiyun CONFIGFS_ATTR(f_uac1_opts_, name)
1867*4882a593Smuzhiyun 
1868*4882a593Smuzhiyun #define UAC1_ATTRIBUTE_STRING(name)					\
1869*4882a593Smuzhiyun static ssize_t f_uac1_opts_##name##_show(struct config_item *item,	\
1870*4882a593Smuzhiyun 					 char *page)			\
1871*4882a593Smuzhiyun {									\
1872*4882a593Smuzhiyun 	struct f_uac1_opts *opts = to_f_uac1_opts(item);		\
1873*4882a593Smuzhiyun 	int result;							\
1874*4882a593Smuzhiyun 									\
1875*4882a593Smuzhiyun 	mutex_lock(&opts->lock);					\
1876*4882a593Smuzhiyun 	result = snprintf(page, sizeof(opts->name), "%s", opts->name);	\
1877*4882a593Smuzhiyun 	mutex_unlock(&opts->lock);					\
1878*4882a593Smuzhiyun 									\
1879*4882a593Smuzhiyun 	return result;							\
1880*4882a593Smuzhiyun }									\
1881*4882a593Smuzhiyun 									\
1882*4882a593Smuzhiyun static ssize_t f_uac1_opts_##name##_store(struct config_item *item,	\
1883*4882a593Smuzhiyun 					  const char *page, size_t len)	\
1884*4882a593Smuzhiyun {									\
1885*4882a593Smuzhiyun 	struct f_uac1_opts *opts = to_f_uac1_opts(item);		\
1886*4882a593Smuzhiyun 	int ret = 0;							\
1887*4882a593Smuzhiyun 									\
1888*4882a593Smuzhiyun 	mutex_lock(&opts->lock);					\
1889*4882a593Smuzhiyun 	if (opts->refcnt) {						\
1890*4882a593Smuzhiyun 		ret = -EBUSY;						\
1891*4882a593Smuzhiyun 		goto end;						\
1892*4882a593Smuzhiyun 	}								\
1893*4882a593Smuzhiyun 									\
1894*4882a593Smuzhiyun 	ret = snprintf(opts->name, min(sizeof(opts->name), len),	\
1895*4882a593Smuzhiyun 			"%s", page);					\
1896*4882a593Smuzhiyun 									\
1897*4882a593Smuzhiyun end:									\
1898*4882a593Smuzhiyun 	mutex_unlock(&opts->lock);					\
1899*4882a593Smuzhiyun 	return ret;							\
1900*4882a593Smuzhiyun }									\
1901*4882a593Smuzhiyun 									\
1902*4882a593Smuzhiyun CONFIGFS_ATTR(f_uac1_opts_, name)
1903*4882a593Smuzhiyun 
1904*4882a593Smuzhiyun UAC1_ATTRIBUTE(u32, c_chmask);
1905*4882a593Smuzhiyun UAC1_RATE_ATTRIBUTE(c_srate);
1906*4882a593Smuzhiyun UAC1_ATTRIBUTE(u32, c_ssize);
1907*4882a593Smuzhiyun UAC1_ATTRIBUTE(u32, p_chmask);
1908*4882a593Smuzhiyun UAC1_RATE_ATTRIBUTE(p_srate);
1909*4882a593Smuzhiyun UAC1_ATTRIBUTE(u32, p_ssize);
1910*4882a593Smuzhiyun UAC1_ATTRIBUTE(u32, req_number);
1911*4882a593Smuzhiyun 
1912*4882a593Smuzhiyun UAC1_ATTRIBUTE(bool, p_mute_present);
1913*4882a593Smuzhiyun UAC1_ATTRIBUTE(bool, p_volume_present);
1914*4882a593Smuzhiyun UAC1_ATTRIBUTE(s16, p_volume_min);
1915*4882a593Smuzhiyun UAC1_ATTRIBUTE(s16, p_volume_max);
1916*4882a593Smuzhiyun UAC1_ATTRIBUTE(s16, p_volume_res);
1917*4882a593Smuzhiyun 
1918*4882a593Smuzhiyun UAC1_ATTRIBUTE(bool, c_mute_present);
1919*4882a593Smuzhiyun UAC1_ATTRIBUTE(bool, c_volume_present);
1920*4882a593Smuzhiyun UAC1_ATTRIBUTE(s16, c_volume_min);
1921*4882a593Smuzhiyun UAC1_ATTRIBUTE(s16, c_volume_max);
1922*4882a593Smuzhiyun UAC1_ATTRIBUTE(s16, c_volume_res);
1923*4882a593Smuzhiyun UAC1_ATTRIBUTE_STRING(function_name);
1924*4882a593Smuzhiyun 
1925*4882a593Smuzhiyun static struct configfs_attribute *f_uac1_attrs[] = {
1926*4882a593Smuzhiyun 	&f_uac1_opts_attr_c_chmask,
1927*4882a593Smuzhiyun 	&f_uac1_opts_attr_c_srate,
1928*4882a593Smuzhiyun 	&f_uac1_opts_attr_c_ssize,
1929*4882a593Smuzhiyun 	&f_uac1_opts_attr_p_chmask,
1930*4882a593Smuzhiyun 	&f_uac1_opts_attr_p_srate,
1931*4882a593Smuzhiyun 	&f_uac1_opts_attr_p_ssize,
1932*4882a593Smuzhiyun 	&f_uac1_opts_attr_req_number,
1933*4882a593Smuzhiyun 
1934*4882a593Smuzhiyun 	&f_uac1_opts_attr_p_mute_present,
1935*4882a593Smuzhiyun 	&f_uac1_opts_attr_p_volume_present,
1936*4882a593Smuzhiyun 	&f_uac1_opts_attr_p_volume_min,
1937*4882a593Smuzhiyun 	&f_uac1_opts_attr_p_volume_max,
1938*4882a593Smuzhiyun 	&f_uac1_opts_attr_p_volume_res,
1939*4882a593Smuzhiyun 
1940*4882a593Smuzhiyun 	&f_uac1_opts_attr_c_mute_present,
1941*4882a593Smuzhiyun 	&f_uac1_opts_attr_c_volume_present,
1942*4882a593Smuzhiyun 	&f_uac1_opts_attr_c_volume_min,
1943*4882a593Smuzhiyun 	&f_uac1_opts_attr_c_volume_max,
1944*4882a593Smuzhiyun 	&f_uac1_opts_attr_c_volume_res,
1945*4882a593Smuzhiyun 
1946*4882a593Smuzhiyun 	&f_uac1_opts_attr_function_name,
1947*4882a593Smuzhiyun 
1948*4882a593Smuzhiyun 	NULL,
1949*4882a593Smuzhiyun };
1950*4882a593Smuzhiyun 
1951*4882a593Smuzhiyun static const struct config_item_type f_uac1_func_type = {
1952*4882a593Smuzhiyun 	.ct_item_ops	= &f_uac1_item_ops,
1953*4882a593Smuzhiyun 	.ct_attrs	= f_uac1_attrs,
1954*4882a593Smuzhiyun 	.ct_owner	= THIS_MODULE,
1955*4882a593Smuzhiyun };
1956*4882a593Smuzhiyun 
f_audio_free_inst(struct usb_function_instance * f)1957*4882a593Smuzhiyun static void f_audio_free_inst(struct usb_function_instance *f)
1958*4882a593Smuzhiyun {
1959*4882a593Smuzhiyun 	struct f_uac1_opts *opts;
1960*4882a593Smuzhiyun 
1961*4882a593Smuzhiyun 	opts = container_of(f, struct f_uac1_opts, func_inst);
1962*4882a593Smuzhiyun 	kfree(opts);
1963*4882a593Smuzhiyun }
1964*4882a593Smuzhiyun 
f_audio_alloc_inst(void)1965*4882a593Smuzhiyun static struct usb_function_instance *f_audio_alloc_inst(void)
1966*4882a593Smuzhiyun {
1967*4882a593Smuzhiyun 	struct f_uac1_opts *opts;
1968*4882a593Smuzhiyun 
1969*4882a593Smuzhiyun 	opts = kzalloc(sizeof(*opts), GFP_KERNEL);
1970*4882a593Smuzhiyun 	if (!opts)
1971*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
1972*4882a593Smuzhiyun 
1973*4882a593Smuzhiyun 	mutex_init(&opts->lock);
1974*4882a593Smuzhiyun 	opts->func_inst.free_func_inst = f_audio_free_inst;
1975*4882a593Smuzhiyun 
1976*4882a593Smuzhiyun 	config_group_init_type_name(&opts->func_inst.group, "",
1977*4882a593Smuzhiyun 				    &f_uac1_func_type);
1978*4882a593Smuzhiyun 
1979*4882a593Smuzhiyun 	opts->c_chmask = UAC1_DEF_CCHMASK;
1980*4882a593Smuzhiyun 	opts->c_srates[0] = UAC1_DEF_CSRATE;
1981*4882a593Smuzhiyun 	opts->c_ssize = UAC1_DEF_CSSIZE;
1982*4882a593Smuzhiyun 	opts->p_chmask = UAC1_DEF_PCHMASK;
1983*4882a593Smuzhiyun 	opts->p_srates[0] = UAC1_DEF_PSRATE;
1984*4882a593Smuzhiyun 	opts->p_ssize = UAC1_DEF_PSSIZE;
1985*4882a593Smuzhiyun 
1986*4882a593Smuzhiyun 	opts->p_mute_present = UAC1_DEF_MUTE_PRESENT;
1987*4882a593Smuzhiyun 	opts->p_volume_present = UAC1_DEF_VOLUME_PRESENT;
1988*4882a593Smuzhiyun 	opts->p_volume_min = UAC1_DEF_MIN_DB;
1989*4882a593Smuzhiyun 	opts->p_volume_max = UAC1_DEF_MAX_DB;
1990*4882a593Smuzhiyun 	opts->p_volume_res = UAC1_DEF_RES_DB;
1991*4882a593Smuzhiyun 
1992*4882a593Smuzhiyun 	opts->c_mute_present = UAC1_DEF_MUTE_PRESENT;
1993*4882a593Smuzhiyun 	opts->c_volume_present = UAC1_DEF_VOLUME_PRESENT;
1994*4882a593Smuzhiyun 	opts->c_volume_min = UAC1_DEF_MIN_DB;
1995*4882a593Smuzhiyun 	opts->c_volume_max = UAC1_DEF_MAX_DB;
1996*4882a593Smuzhiyun 	opts->c_volume_res = UAC1_DEF_RES_DB;
1997*4882a593Smuzhiyun 
1998*4882a593Smuzhiyun 	opts->req_number = UAC1_DEF_REQ_NUM;
1999*4882a593Smuzhiyun 
2000*4882a593Smuzhiyun 	snprintf(opts->function_name, sizeof(opts->function_name), "Source/Sink");
2001*4882a593Smuzhiyun 
2002*4882a593Smuzhiyun 	return &opts->func_inst;
2003*4882a593Smuzhiyun }
2004*4882a593Smuzhiyun 
f_audio_free(struct usb_function * f)2005*4882a593Smuzhiyun static void f_audio_free(struct usb_function *f)
2006*4882a593Smuzhiyun {
2007*4882a593Smuzhiyun 	struct g_audio *audio;
2008*4882a593Smuzhiyun 	struct f_uac1_opts *opts;
2009*4882a593Smuzhiyun 
2010*4882a593Smuzhiyun 	audio = func_to_g_audio(f);
2011*4882a593Smuzhiyun 	opts = container_of(f->fi, struct f_uac1_opts, func_inst);
2012*4882a593Smuzhiyun 	kfree(audio);
2013*4882a593Smuzhiyun 	mutex_lock(&opts->lock);
2014*4882a593Smuzhiyun 	--opts->refcnt;
2015*4882a593Smuzhiyun 	mutex_unlock(&opts->lock);
2016*4882a593Smuzhiyun }
2017*4882a593Smuzhiyun 
f_audio_unbind(struct usb_configuration * c,struct usb_function * f)2018*4882a593Smuzhiyun static void f_audio_unbind(struct usb_configuration *c, struct usb_function *f)
2019*4882a593Smuzhiyun {
2020*4882a593Smuzhiyun 	struct g_audio *audio = func_to_g_audio(f);
2021*4882a593Smuzhiyun 
2022*4882a593Smuzhiyun 	g_audio_cleanup(audio);
2023*4882a593Smuzhiyun 	usb_free_all_descriptors(f);
2024*4882a593Smuzhiyun 
2025*4882a593Smuzhiyun 	kfree(out_feature_unit_desc);
2026*4882a593Smuzhiyun 	out_feature_unit_desc = NULL;
2027*4882a593Smuzhiyun 	kfree(in_feature_unit_desc);
2028*4882a593Smuzhiyun 	in_feature_unit_desc = NULL;
2029*4882a593Smuzhiyun 
2030*4882a593Smuzhiyun 	kfree(ac_header_desc);
2031*4882a593Smuzhiyun 	ac_header_desc = NULL;
2032*4882a593Smuzhiyun 
2033*4882a593Smuzhiyun 	audio->gadget = NULL;
2034*4882a593Smuzhiyun }
2035*4882a593Smuzhiyun 
f_audio_alloc(struct usb_function_instance * fi)2036*4882a593Smuzhiyun static struct usb_function *f_audio_alloc(struct usb_function_instance *fi)
2037*4882a593Smuzhiyun {
2038*4882a593Smuzhiyun 	struct f_uac1 *uac1;
2039*4882a593Smuzhiyun 	struct f_uac1_opts *opts;
2040*4882a593Smuzhiyun 
2041*4882a593Smuzhiyun 	/* allocate and initialize one new instance */
2042*4882a593Smuzhiyun 	uac1 = kzalloc(sizeof(*uac1), GFP_KERNEL);
2043*4882a593Smuzhiyun 	if (!uac1)
2044*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
2045*4882a593Smuzhiyun 
2046*4882a593Smuzhiyun 	opts = container_of(fi, struct f_uac1_opts, func_inst);
2047*4882a593Smuzhiyun 	mutex_lock(&opts->lock);
2048*4882a593Smuzhiyun 	++opts->refcnt;
2049*4882a593Smuzhiyun 	mutex_unlock(&opts->lock);
2050*4882a593Smuzhiyun 
2051*4882a593Smuzhiyun 	uac1->g_audio.func.name = "uac1_func";
2052*4882a593Smuzhiyun 	uac1->g_audio.func.bind = f_audio_bind;
2053*4882a593Smuzhiyun 	uac1->g_audio.func.unbind = f_audio_unbind;
2054*4882a593Smuzhiyun 	uac1->g_audio.func.set_alt = f_audio_set_alt;
2055*4882a593Smuzhiyun 	uac1->g_audio.func.get_alt = f_audio_get_alt;
2056*4882a593Smuzhiyun 	uac1->g_audio.func.setup = f_audio_setup;
2057*4882a593Smuzhiyun 	uac1->g_audio.func.disable = f_audio_disable;
2058*4882a593Smuzhiyun 	uac1->g_audio.func.suspend = f_audio_suspend;
2059*4882a593Smuzhiyun 	uac1->g_audio.func.free_func = f_audio_free;
2060*4882a593Smuzhiyun 
2061*4882a593Smuzhiyun 	return &uac1->g_audio.func;
2062*4882a593Smuzhiyun }
2063*4882a593Smuzhiyun 
2064*4882a593Smuzhiyun DECLARE_USB_FUNCTION_INIT(uac1, f_audio_alloc_inst, f_audio_alloc);
2065*4882a593Smuzhiyun MODULE_LICENSE("GPL");
2066*4882a593Smuzhiyun MODULE_AUTHOR("Ruslan Bilovol");
2067