xref: /rk3399_rockchip-uboot/drivers/usb/gadget/f_dfu.c (revision 12ff19dbfd93abdb62b7b326fee3f5bfa659a75e)
1b819ddbfSLukasz Majewski /*
2b819ddbfSLukasz Majewski  * f_dfu.c -- Device Firmware Update USB function
3b819ddbfSLukasz Majewski  *
4b819ddbfSLukasz Majewski  * Copyright (C) 2012 Samsung Electronics
5b819ddbfSLukasz Majewski  * authors: Andrzej Pietrasiewicz <andrzej.p@samsung.com>
6b819ddbfSLukasz Majewski  *          Lukasz Majewski <l.majewski@samsung.com>
7b819ddbfSLukasz Majewski  *
881c065d2SŁukasz Majewski  * Based on OpenMoko u-boot: drivers/usb/usbdfu.c
981c065d2SŁukasz Majewski  * (C) 2007 by OpenMoko, Inc.
1081c065d2SŁukasz Majewski  * Author: Harald Welte <laforge@openmoko.org>
1181c065d2SŁukasz Majewski  *
1281c065d2SŁukasz Majewski  * based on existing SAM7DFU code from OpenPCD:
1381c065d2SŁukasz Majewski  * (C) Copyright 2006 by Harald Welte <hwelte at hmw-consulting.de>
1481c065d2SŁukasz Majewski  *
151a459660SWolfgang Denk  * SPDX-License-Identifier:	GPL-2.0+
16b819ddbfSLukasz Majewski  */
17b819ddbfSLukasz Majewski 
18b819ddbfSLukasz Majewski #include <errno.h>
19b819ddbfSLukasz Majewski #include <common.h>
20b819ddbfSLukasz Majewski #include <malloc.h>
21b819ddbfSLukasz Majewski 
22b819ddbfSLukasz Majewski #include <linux/usb/ch9.h>
23b819ddbfSLukasz Majewski #include <linux/usb/gadget.h>
24b819ddbfSLukasz Majewski #include <linux/usb/composite.h>
25b819ddbfSLukasz Majewski 
26b819ddbfSLukasz Majewski #include <dfu.h>
27c4d0e856SMateusz Zalega #include <g_dnl.h>
28b819ddbfSLukasz Majewski #include "f_dfu.h"
29b819ddbfSLukasz Majewski 
30b819ddbfSLukasz Majewski struct f_dfu {
31b819ddbfSLukasz Majewski 	struct usb_function		usb_function;
32b819ddbfSLukasz Majewski 
33b819ddbfSLukasz Majewski 	struct usb_descriptor_header	**function;
34b819ddbfSLukasz Majewski 	struct usb_string		*strings;
35b819ddbfSLukasz Majewski 
36b819ddbfSLukasz Majewski 	/* when configured, we have one config */
37b819ddbfSLukasz Majewski 	u8				config;
38b819ddbfSLukasz Majewski 	u8				altsetting;
39b819ddbfSLukasz Majewski 	enum dfu_state			dfu_state;
40b819ddbfSLukasz Majewski 	unsigned int			dfu_status;
41b819ddbfSLukasz Majewski 
42b819ddbfSLukasz Majewski 	/* Send/received block number is handy for data integrity check */
43b819ddbfSLukasz Majewski 	int                             blk_seq_num;
4433fac4a6SLukasz Majewski 	unsigned int                    poll_timeout;
45b819ddbfSLukasz Majewski };
46b819ddbfSLukasz Majewski 
47fc18f8d1SLukasz Majewski struct dfu_entity *dfu_defer_flush;
48fc18f8d1SLukasz Majewski 
49b819ddbfSLukasz Majewski typedef int (*dfu_state_fn) (struct f_dfu *,
50b819ddbfSLukasz Majewski 			     const struct usb_ctrlrequest *,
51b819ddbfSLukasz Majewski 			     struct usb_gadget *,
52b819ddbfSLukasz Majewski 			     struct usb_request *);
53b819ddbfSLukasz Majewski 
54b819ddbfSLukasz Majewski static inline struct f_dfu *func_to_dfu(struct usb_function *f)
55b819ddbfSLukasz Majewski {
56b819ddbfSLukasz Majewski 	return container_of(f, struct f_dfu, usb_function);
57b819ddbfSLukasz Majewski }
58b819ddbfSLukasz Majewski 
59b819ddbfSLukasz Majewski static const struct dfu_function_descriptor dfu_func = {
60b819ddbfSLukasz Majewski 	.bLength =		sizeof dfu_func,
61b819ddbfSLukasz Majewski 	.bDescriptorType =	DFU_DT_FUNC,
62b819ddbfSLukasz Majewski 	.bmAttributes =		DFU_BIT_WILL_DETACH |
63b819ddbfSLukasz Majewski 				DFU_BIT_MANIFESTATION_TOLERANT |
64b819ddbfSLukasz Majewski 				DFU_BIT_CAN_UPLOAD |
65b819ddbfSLukasz Majewski 				DFU_BIT_CAN_DNLOAD,
66b819ddbfSLukasz Majewski 	.wDetachTimeOut =	0,
67b819ddbfSLukasz Majewski 	.wTransferSize =	DFU_USB_BUFSIZ,
68b819ddbfSLukasz Majewski 	.bcdDFUVersion =	__constant_cpu_to_le16(0x0110),
69b819ddbfSLukasz Majewski };
70b819ddbfSLukasz Majewski 
71b819ddbfSLukasz Majewski static struct usb_interface_descriptor dfu_intf_runtime = {
72b819ddbfSLukasz Majewski 	.bLength =		sizeof dfu_intf_runtime,
73b819ddbfSLukasz Majewski 	.bDescriptorType =	USB_DT_INTERFACE,
74b819ddbfSLukasz Majewski 	.bNumEndpoints =	0,
75b819ddbfSLukasz Majewski 	.bInterfaceClass =	USB_CLASS_APP_SPEC,
76b819ddbfSLukasz Majewski 	.bInterfaceSubClass =	1,
77b819ddbfSLukasz Majewski 	.bInterfaceProtocol =	1,
78b819ddbfSLukasz Majewski 	/* .iInterface = DYNAMIC */
79b819ddbfSLukasz Majewski };
80b819ddbfSLukasz Majewski 
81b819ddbfSLukasz Majewski static struct usb_descriptor_header *dfu_runtime_descs[] = {
82b819ddbfSLukasz Majewski 	(struct usb_descriptor_header *) &dfu_intf_runtime,
83b819ddbfSLukasz Majewski 	NULL,
84b819ddbfSLukasz Majewski };
85b819ddbfSLukasz Majewski 
86b819ddbfSLukasz Majewski static const char dfu_name[] = "Device Firmware Upgrade";
87b819ddbfSLukasz Majewski 
88b819ddbfSLukasz Majewski /*
89b819ddbfSLukasz Majewski  * static strings, in UTF-8
90b819ddbfSLukasz Majewski  *
91b819ddbfSLukasz Majewski  * dfu_generic configuration
92b819ddbfSLukasz Majewski  */
93b819ddbfSLukasz Majewski static struct usb_string strings_dfu_generic[] = {
94b819ddbfSLukasz Majewski 	[0].s = dfu_name,
95b819ddbfSLukasz Majewski 	{  }			/* end of list */
96b819ddbfSLukasz Majewski };
97b819ddbfSLukasz Majewski 
98b819ddbfSLukasz Majewski static struct usb_gadget_strings stringtab_dfu_generic = {
99b819ddbfSLukasz Majewski 	.language	= 0x0409,	/* en-us */
100b819ddbfSLukasz Majewski 	.strings	= strings_dfu_generic,
101b819ddbfSLukasz Majewski };
102b819ddbfSLukasz Majewski 
103b819ddbfSLukasz Majewski static struct usb_gadget_strings *dfu_generic_strings[] = {
104b819ddbfSLukasz Majewski 	&stringtab_dfu_generic,
105b819ddbfSLukasz Majewski 	NULL,
106b819ddbfSLukasz Majewski };
107b819ddbfSLukasz Majewski 
108b819ddbfSLukasz Majewski /*
109b819ddbfSLukasz Majewski  * usb_function specific
110b819ddbfSLukasz Majewski  */
111b819ddbfSLukasz Majewski static struct usb_gadget_strings stringtab_dfu = {
112b819ddbfSLukasz Majewski 	.language	= 0x0409,	/* en-us */
113b819ddbfSLukasz Majewski 	/*
114b819ddbfSLukasz Majewski 	 * .strings
115b819ddbfSLukasz Majewski 	 *
116b819ddbfSLukasz Majewski 	 * assigned during initialization,
117b819ddbfSLukasz Majewski 	 * depends on number of flash entities
118b819ddbfSLukasz Majewski 	 *
119b819ddbfSLukasz Majewski 	 */
120b819ddbfSLukasz Majewski };
121b819ddbfSLukasz Majewski 
122b819ddbfSLukasz Majewski static struct usb_gadget_strings *dfu_strings[] = {
123b819ddbfSLukasz Majewski 	&stringtab_dfu,
124b819ddbfSLukasz Majewski 	NULL,
125b819ddbfSLukasz Majewski };
126b819ddbfSLukasz Majewski 
12733fac4a6SLukasz Majewski static void dfu_set_poll_timeout(struct dfu_status *dstat, unsigned int ms)
12833fac4a6SLukasz Majewski {
12933fac4a6SLukasz Majewski 	/*
13033fac4a6SLukasz Majewski 	 * The bwPollTimeout DFU_GETSTATUS request payload provides information
13133fac4a6SLukasz Majewski 	 * about minimum time, in milliseconds, that the host should wait before
13233fac4a6SLukasz Majewski 	 * sending a subsequent DFU_GETSTATUS request
13333fac4a6SLukasz Majewski 	 *
13433fac4a6SLukasz Majewski 	 * This permits the device to vary the delay depending on its need to
13533fac4a6SLukasz Majewski 	 * erase or program the memory
13633fac4a6SLukasz Majewski 	 *
13733fac4a6SLukasz Majewski 	 */
13833fac4a6SLukasz Majewski 
13933fac4a6SLukasz Majewski 	unsigned char *p = (unsigned char *)&ms;
14033fac4a6SLukasz Majewski 
14133fac4a6SLukasz Majewski 	if (!ms || (ms & ~DFU_POLL_TIMEOUT_MASK)) {
14233fac4a6SLukasz Majewski 		dstat->bwPollTimeout[0] = 0;
14333fac4a6SLukasz Majewski 		dstat->bwPollTimeout[1] = 0;
14433fac4a6SLukasz Majewski 		dstat->bwPollTimeout[2] = 0;
14533fac4a6SLukasz Majewski 
14633fac4a6SLukasz Majewski 		return;
14733fac4a6SLukasz Majewski 	}
14833fac4a6SLukasz Majewski 
14933fac4a6SLukasz Majewski 	dstat->bwPollTimeout[0] = *p++;
15033fac4a6SLukasz Majewski 	dstat->bwPollTimeout[1] = *p++;
15133fac4a6SLukasz Majewski 	dstat->bwPollTimeout[2] = *p;
15233fac4a6SLukasz Majewski }
15333fac4a6SLukasz Majewski 
154b819ddbfSLukasz Majewski /*-------------------------------------------------------------------------*/
155b819ddbfSLukasz Majewski 
156b819ddbfSLukasz Majewski static void dnload_request_complete(struct usb_ep *ep, struct usb_request *req)
157b819ddbfSLukasz Majewski {
158b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu = req->context;
1593ee9593fSStephen Warren 	int ret;
160b819ddbfSLukasz Majewski 
1613ee9593fSStephen Warren 	ret = dfu_write(dfu_get_entity(f_dfu->altsetting), req->buf,
162b819ddbfSLukasz Majewski 			req->length, f_dfu->blk_seq_num);
1633ee9593fSStephen Warren 	if (ret) {
1643ee9593fSStephen Warren 		f_dfu->dfu_status = DFU_STATUS_errUNKNOWN;
1653ee9593fSStephen Warren 		f_dfu->dfu_state = DFU_STATE_dfuERROR;
1663ee9593fSStephen Warren 	}
167001a8319SHeiko Schocher }
168b819ddbfSLukasz Majewski 
169001a8319SHeiko Schocher static void dnload_request_flush(struct usb_ep *ep, struct usb_request *req)
170001a8319SHeiko Schocher {
171001a8319SHeiko Schocher 	struct f_dfu *f_dfu = req->context;
172fc18f8d1SLukasz Majewski 	dfu_set_defer_flush(dfu_get_entity(f_dfu->altsetting));
173b819ddbfSLukasz Majewski }
174b819ddbfSLukasz Majewski 
175fc25fa27SHeiko Schocher static inline int dfu_get_manifest_timeout(struct dfu_entity *dfu)
176fc25fa27SHeiko Schocher {
177fc25fa27SHeiko Schocher 	return dfu->poll_timeout ? dfu->poll_timeout(dfu) :
178fc25fa27SHeiko Schocher 		DFU_MANIFEST_POLL_TIMEOUT;
179fc25fa27SHeiko Schocher }
180fc25fa27SHeiko Schocher 
181b819ddbfSLukasz Majewski static void handle_getstatus(struct usb_request *req)
182b819ddbfSLukasz Majewski {
183b819ddbfSLukasz Majewski 	struct dfu_status *dstat = (struct dfu_status *)req->buf;
184b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu = req->context;
185fc25fa27SHeiko Schocher 	struct dfu_entity *dfu = dfu_get_entity(f_dfu->altsetting);
186b819ddbfSLukasz Majewski 
187001a8319SHeiko Schocher 	dfu_set_poll_timeout(dstat, 0);
188001a8319SHeiko Schocher 
189b819ddbfSLukasz Majewski 	switch (f_dfu->dfu_state) {
190b819ddbfSLukasz Majewski 	case DFU_STATE_dfuDNLOAD_SYNC:
191b819ddbfSLukasz Majewski 	case DFU_STATE_dfuDNBUSY:
192b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuDNLOAD_IDLE;
193b819ddbfSLukasz Majewski 		break;
194b819ddbfSLukasz Majewski 	case DFU_STATE_dfuMANIFEST_SYNC:
195001a8319SHeiko Schocher 		f_dfu->dfu_state = DFU_STATE_dfuMANIFEST;
196b819ddbfSLukasz Majewski 		break;
197001a8319SHeiko Schocher 	case DFU_STATE_dfuMANIFEST:
198fc25fa27SHeiko Schocher 		dfu_set_poll_timeout(dstat, dfu_get_manifest_timeout(dfu));
199fc25fa27SHeiko Schocher 		break;
200b819ddbfSLukasz Majewski 	default:
201b819ddbfSLukasz Majewski 		break;
202b819ddbfSLukasz Majewski 	}
203b819ddbfSLukasz Majewski 
20433fac4a6SLukasz Majewski 	if (f_dfu->poll_timeout)
20533fac4a6SLukasz Majewski 		if (!(f_dfu->blk_seq_num %
20633fac4a6SLukasz Majewski 		      (dfu_get_buf_size() / DFU_USB_BUFSIZ)))
20733fac4a6SLukasz Majewski 			dfu_set_poll_timeout(dstat, f_dfu->poll_timeout);
20833fac4a6SLukasz Majewski 
209b819ddbfSLukasz Majewski 	/* send status response */
210b819ddbfSLukasz Majewski 	dstat->bStatus = f_dfu->dfu_status;
211b819ddbfSLukasz Majewski 	dstat->bState = f_dfu->dfu_state;
212b819ddbfSLukasz Majewski 	dstat->iString = 0;
213b819ddbfSLukasz Majewski }
214b819ddbfSLukasz Majewski 
215b819ddbfSLukasz Majewski static void handle_getstate(struct usb_request *req)
216b819ddbfSLukasz Majewski {
217b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu = req->context;
218b819ddbfSLukasz Majewski 
219b819ddbfSLukasz Majewski 	((u8 *)req->buf)[0] = f_dfu->dfu_state;
220b819ddbfSLukasz Majewski 	req->actual = sizeof(u8);
221b819ddbfSLukasz Majewski }
222b819ddbfSLukasz Majewski 
223b819ddbfSLukasz Majewski static inline void to_dfu_mode(struct f_dfu *f_dfu)
224b819ddbfSLukasz Majewski {
225b819ddbfSLukasz Majewski 	f_dfu->usb_function.strings = dfu_strings;
226b819ddbfSLukasz Majewski 	f_dfu->usb_function.hs_descriptors = f_dfu->function;
2279f3b8ed1SHeiko Schocher 	f_dfu->usb_function.descriptors = f_dfu->function;
228ad5f9778SHeiko Schocher 	f_dfu->dfu_state = DFU_STATE_dfuIDLE;
229b819ddbfSLukasz Majewski }
230b819ddbfSLukasz Majewski 
231b819ddbfSLukasz Majewski static inline void to_runtime_mode(struct f_dfu *f_dfu)
232b819ddbfSLukasz Majewski {
233b819ddbfSLukasz Majewski 	f_dfu->usb_function.strings = NULL;
234b819ddbfSLukasz Majewski 	f_dfu->usb_function.hs_descriptors = dfu_runtime_descs;
2359f3b8ed1SHeiko Schocher 	f_dfu->usb_function.descriptors = dfu_runtime_descs;
236b819ddbfSLukasz Majewski }
237b819ddbfSLukasz Majewski 
238b819ddbfSLukasz Majewski static int handle_upload(struct usb_request *req, u16 len)
239b819ddbfSLukasz Majewski {
240b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu = req->context;
241b819ddbfSLukasz Majewski 
242b819ddbfSLukasz Majewski 	return dfu_read(dfu_get_entity(f_dfu->altsetting), req->buf,
243b819ddbfSLukasz Majewski 			req->length, f_dfu->blk_seq_num);
244b819ddbfSLukasz Majewski }
245b819ddbfSLukasz Majewski 
246b819ddbfSLukasz Majewski static int handle_dnload(struct usb_gadget *gadget, u16 len)
247b819ddbfSLukasz Majewski {
248b819ddbfSLukasz Majewski 	struct usb_composite_dev *cdev = get_gadget_data(gadget);
249b819ddbfSLukasz Majewski 	struct usb_request *req = cdev->req;
250b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu = req->context;
251b819ddbfSLukasz Majewski 
252b819ddbfSLukasz Majewski 	if (len == 0)
253b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuMANIFEST_SYNC;
254b819ddbfSLukasz Majewski 
255b819ddbfSLukasz Majewski 	req->complete = dnload_request_complete;
256b819ddbfSLukasz Majewski 
257b819ddbfSLukasz Majewski 	return len;
258b819ddbfSLukasz Majewski }
259b819ddbfSLukasz Majewski 
260b819ddbfSLukasz Majewski /*-------------------------------------------------------------------------*/
261b819ddbfSLukasz Majewski /* DFU state machine  */
262b819ddbfSLukasz Majewski static int state_app_idle(struct f_dfu *f_dfu,
263b819ddbfSLukasz Majewski 			  const struct usb_ctrlrequest *ctrl,
264b819ddbfSLukasz Majewski 			  struct usb_gadget *gadget,
265b819ddbfSLukasz Majewski 			  struct usb_request *req)
266b819ddbfSLukasz Majewski {
267b819ddbfSLukasz Majewski 	int value = 0;
268b819ddbfSLukasz Majewski 
269b819ddbfSLukasz Majewski 	switch (ctrl->bRequest) {
270b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATUS:
271b819ddbfSLukasz Majewski 		handle_getstatus(req);
272b819ddbfSLukasz Majewski 		value = RET_STAT_LEN;
273b819ddbfSLukasz Majewski 		break;
274b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATE:
275b819ddbfSLukasz Majewski 		handle_getstate(req);
276b819ddbfSLukasz Majewski 		break;
277b819ddbfSLukasz Majewski 	case USB_REQ_DFU_DETACH:
278b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_appDETACH;
279b819ddbfSLukasz Majewski 		to_dfu_mode(f_dfu);
280b819ddbfSLukasz Majewski 		value = RET_ZLP;
281b819ddbfSLukasz Majewski 		break;
282b819ddbfSLukasz Majewski 	default:
283b819ddbfSLukasz Majewski 		value = RET_STALL;
284b819ddbfSLukasz Majewski 		break;
285b819ddbfSLukasz Majewski 	}
286b819ddbfSLukasz Majewski 
287b819ddbfSLukasz Majewski 	return value;
288b819ddbfSLukasz Majewski }
289b819ddbfSLukasz Majewski 
290b819ddbfSLukasz Majewski static int state_app_detach(struct f_dfu *f_dfu,
291b819ddbfSLukasz Majewski 			    const struct usb_ctrlrequest *ctrl,
292b819ddbfSLukasz Majewski 			    struct usb_gadget *gadget,
293b819ddbfSLukasz Majewski 			    struct usb_request *req)
294b819ddbfSLukasz Majewski {
295b819ddbfSLukasz Majewski 	int value = 0;
296b819ddbfSLukasz Majewski 
297b819ddbfSLukasz Majewski 	switch (ctrl->bRequest) {
298b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATUS:
299b819ddbfSLukasz Majewski 		handle_getstatus(req);
300b819ddbfSLukasz Majewski 		value = RET_STAT_LEN;
301b819ddbfSLukasz Majewski 		break;
302b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATE:
303b819ddbfSLukasz Majewski 		handle_getstate(req);
304b819ddbfSLukasz Majewski 		break;
305b819ddbfSLukasz Majewski 	default:
306b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_appIDLE;
307b819ddbfSLukasz Majewski 		value = RET_STALL;
308b819ddbfSLukasz Majewski 		break;
309b819ddbfSLukasz Majewski 	}
310b819ddbfSLukasz Majewski 
311b819ddbfSLukasz Majewski 	return value;
312b819ddbfSLukasz Majewski }
313b819ddbfSLukasz Majewski 
314b819ddbfSLukasz Majewski static int state_dfu_idle(struct f_dfu *f_dfu,
315b819ddbfSLukasz Majewski 			  const struct usb_ctrlrequest *ctrl,
316b819ddbfSLukasz Majewski 			  struct usb_gadget *gadget,
317b819ddbfSLukasz Majewski 			  struct usb_request *req)
318b819ddbfSLukasz Majewski {
319b819ddbfSLukasz Majewski 	u16 w_value = le16_to_cpu(ctrl->wValue);
320b819ddbfSLukasz Majewski 	u16 len = le16_to_cpu(ctrl->wLength);
321b819ddbfSLukasz Majewski 	int value = 0;
322b819ddbfSLukasz Majewski 
323b819ddbfSLukasz Majewski 	switch (ctrl->bRequest) {
324b819ddbfSLukasz Majewski 	case USB_REQ_DFU_DNLOAD:
325b819ddbfSLukasz Majewski 		if (len == 0) {
326b819ddbfSLukasz Majewski 			f_dfu->dfu_state = DFU_STATE_dfuERROR;
327b819ddbfSLukasz Majewski 			value = RET_STALL;
328b819ddbfSLukasz Majewski 			break;
329b819ddbfSLukasz Majewski 		}
330b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuDNLOAD_SYNC;
331b819ddbfSLukasz Majewski 		f_dfu->blk_seq_num = w_value;
332b819ddbfSLukasz Majewski 		value = handle_dnload(gadget, len);
333b819ddbfSLukasz Majewski 		break;
334b819ddbfSLukasz Majewski 	case USB_REQ_DFU_UPLOAD:
335b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuUPLOAD_IDLE;
336b819ddbfSLukasz Majewski 		f_dfu->blk_seq_num = 0;
337b819ddbfSLukasz Majewski 		value = handle_upload(req, len);
338b819ddbfSLukasz Majewski 		break;
339b819ddbfSLukasz Majewski 	case USB_REQ_DFU_ABORT:
340b819ddbfSLukasz Majewski 		/* no zlp? */
341b819ddbfSLukasz Majewski 		value = RET_ZLP;
342b819ddbfSLukasz Majewski 		break;
343b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATUS:
344b819ddbfSLukasz Majewski 		handle_getstatus(req);
345b819ddbfSLukasz Majewski 		value = RET_STAT_LEN;
346b819ddbfSLukasz Majewski 		break;
347b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATE:
348b819ddbfSLukasz Majewski 		handle_getstate(req);
349b819ddbfSLukasz Majewski 		break;
350b819ddbfSLukasz Majewski 	case USB_REQ_DFU_DETACH:
351b819ddbfSLukasz Majewski 		/*
352b819ddbfSLukasz Majewski 		 * Proprietary extension: 'detach' from idle mode and
353b819ddbfSLukasz Majewski 		 * get back to runtime mode in case of USB Reset.  As
354b819ddbfSLukasz Majewski 		 * much as I dislike this, we just can't use every USB
355b819ddbfSLukasz Majewski 		 * bus reset to switch back to runtime mode, since at
356b819ddbfSLukasz Majewski 		 * least the Linux USB stack likes to send a number of
357b819ddbfSLukasz Majewski 		 * resets in a row :(
358b819ddbfSLukasz Majewski 		 */
359b819ddbfSLukasz Majewski 		f_dfu->dfu_state =
360b819ddbfSLukasz Majewski 			DFU_STATE_dfuMANIFEST_WAIT_RST;
361b819ddbfSLukasz Majewski 		to_runtime_mode(f_dfu);
362b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_appIDLE;
3636bed7ce5SLukasz Majewski 
364fe1b28c9SRob Herring 		g_dnl_trigger_detach();
365b819ddbfSLukasz Majewski 		break;
366b819ddbfSLukasz Majewski 	default:
367b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuERROR;
368b819ddbfSLukasz Majewski 		value = RET_STALL;
369b819ddbfSLukasz Majewski 		break;
370b819ddbfSLukasz Majewski 	}
371b819ddbfSLukasz Majewski 
372b819ddbfSLukasz Majewski 	return value;
373b819ddbfSLukasz Majewski }
374b819ddbfSLukasz Majewski 
375b819ddbfSLukasz Majewski static int state_dfu_dnload_sync(struct f_dfu *f_dfu,
376b819ddbfSLukasz Majewski 				 const struct usb_ctrlrequest *ctrl,
377b819ddbfSLukasz Majewski 				 struct usb_gadget *gadget,
378b819ddbfSLukasz Majewski 				 struct usb_request *req)
379b819ddbfSLukasz Majewski {
380b819ddbfSLukasz Majewski 	int value = 0;
381b819ddbfSLukasz Majewski 
382b819ddbfSLukasz Majewski 	switch (ctrl->bRequest) {
383b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATUS:
384b819ddbfSLukasz Majewski 		handle_getstatus(req);
385b819ddbfSLukasz Majewski 		value = RET_STAT_LEN;
386b819ddbfSLukasz Majewski 		break;
387b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATE:
388b819ddbfSLukasz Majewski 		handle_getstate(req);
389b819ddbfSLukasz Majewski 		break;
390b819ddbfSLukasz Majewski 	default:
391b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuERROR;
392b819ddbfSLukasz Majewski 		value = RET_STALL;
393b819ddbfSLukasz Majewski 		break;
394b819ddbfSLukasz Majewski 	}
395b819ddbfSLukasz Majewski 
396b819ddbfSLukasz Majewski 	return value;
397b819ddbfSLukasz Majewski }
398b819ddbfSLukasz Majewski 
399b819ddbfSLukasz Majewski static int state_dfu_dnbusy(struct f_dfu *f_dfu,
400b819ddbfSLukasz Majewski 			    const struct usb_ctrlrequest *ctrl,
401b819ddbfSLukasz Majewski 			    struct usb_gadget *gadget,
402b819ddbfSLukasz Majewski 			    struct usb_request *req)
403b819ddbfSLukasz Majewski {
404b819ddbfSLukasz Majewski 	int value = 0;
405b819ddbfSLukasz Majewski 
406b819ddbfSLukasz Majewski 	switch (ctrl->bRequest) {
407b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATUS:
408b819ddbfSLukasz Majewski 		handle_getstatus(req);
409b819ddbfSLukasz Majewski 		value = RET_STAT_LEN;
410b819ddbfSLukasz Majewski 		break;
411b819ddbfSLukasz Majewski 	default:
412b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuERROR;
413b819ddbfSLukasz Majewski 		value = RET_STALL;
414b819ddbfSLukasz Majewski 		break;
415b819ddbfSLukasz Majewski 	}
416b819ddbfSLukasz Majewski 
417b819ddbfSLukasz Majewski 	return value;
418b819ddbfSLukasz Majewski }
419b819ddbfSLukasz Majewski 
420b819ddbfSLukasz Majewski static int state_dfu_dnload_idle(struct f_dfu *f_dfu,
421b819ddbfSLukasz Majewski 				 const struct usb_ctrlrequest *ctrl,
422b819ddbfSLukasz Majewski 				 struct usb_gadget *gadget,
423b819ddbfSLukasz Majewski 				 struct usb_request *req)
424b819ddbfSLukasz Majewski {
425b819ddbfSLukasz Majewski 	u16 w_value = le16_to_cpu(ctrl->wValue);
426b819ddbfSLukasz Majewski 	u16 len = le16_to_cpu(ctrl->wLength);
427b819ddbfSLukasz Majewski 	int value = 0;
428b819ddbfSLukasz Majewski 
429b819ddbfSLukasz Majewski 	switch (ctrl->bRequest) {
430b819ddbfSLukasz Majewski 	case USB_REQ_DFU_DNLOAD:
431b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuDNLOAD_SYNC;
432b819ddbfSLukasz Majewski 		f_dfu->blk_seq_num = w_value;
433b819ddbfSLukasz Majewski 		value = handle_dnload(gadget, len);
434b819ddbfSLukasz Majewski 		break;
435b819ddbfSLukasz Majewski 	case USB_REQ_DFU_ABORT:
436b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuIDLE;
437b819ddbfSLukasz Majewski 		value = RET_ZLP;
438b819ddbfSLukasz Majewski 		break;
439b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATUS:
440b819ddbfSLukasz Majewski 		handle_getstatus(req);
441b819ddbfSLukasz Majewski 		value = RET_STAT_LEN;
442b819ddbfSLukasz Majewski 		break;
443b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATE:
444b819ddbfSLukasz Majewski 		handle_getstate(req);
445b819ddbfSLukasz Majewski 		break;
446b819ddbfSLukasz Majewski 	default:
447b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuERROR;
448b819ddbfSLukasz Majewski 		value = RET_STALL;
449b819ddbfSLukasz Majewski 		break;
450b819ddbfSLukasz Majewski 	}
451b819ddbfSLukasz Majewski 
452b819ddbfSLukasz Majewski 	return value;
453b819ddbfSLukasz Majewski }
454b819ddbfSLukasz Majewski 
455b819ddbfSLukasz Majewski static int state_dfu_manifest_sync(struct f_dfu *f_dfu,
456b819ddbfSLukasz Majewski 				   const struct usb_ctrlrequest *ctrl,
457b819ddbfSLukasz Majewski 				   struct usb_gadget *gadget,
458b819ddbfSLukasz Majewski 				   struct usb_request *req)
459b819ddbfSLukasz Majewski {
460b819ddbfSLukasz Majewski 	int value = 0;
461b819ddbfSLukasz Majewski 
462b819ddbfSLukasz Majewski 	switch (ctrl->bRequest) {
463b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATUS:
464b819ddbfSLukasz Majewski 		/* We're MainfestationTolerant */
465001a8319SHeiko Schocher 		f_dfu->dfu_state = DFU_STATE_dfuMANIFEST;
466b819ddbfSLukasz Majewski 		handle_getstatus(req);
467b819ddbfSLukasz Majewski 		f_dfu->blk_seq_num = 0;
468b819ddbfSLukasz Majewski 		value = RET_STAT_LEN;
469001a8319SHeiko Schocher 		req->complete = dnload_request_flush;
470b819ddbfSLukasz Majewski 		break;
471b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATE:
472b819ddbfSLukasz Majewski 		handle_getstate(req);
473b819ddbfSLukasz Majewski 		break;
474b819ddbfSLukasz Majewski 	default:
475b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuERROR;
476b819ddbfSLukasz Majewski 		value = RET_STALL;
477b819ddbfSLukasz Majewski 		break;
478b819ddbfSLukasz Majewski 	}
479b819ddbfSLukasz Majewski 
480b819ddbfSLukasz Majewski 	return value;
481b819ddbfSLukasz Majewski }
482b819ddbfSLukasz Majewski 
483001a8319SHeiko Schocher static int state_dfu_manifest(struct f_dfu *f_dfu,
484001a8319SHeiko Schocher 			      const struct usb_ctrlrequest *ctrl,
485001a8319SHeiko Schocher 			      struct usb_gadget *gadget,
486001a8319SHeiko Schocher 			      struct usb_request *req)
487001a8319SHeiko Schocher {
488001a8319SHeiko Schocher 	int value = 0;
489001a8319SHeiko Schocher 
490001a8319SHeiko Schocher 	switch (ctrl->bRequest) {
491001a8319SHeiko Schocher 	case USB_REQ_DFU_GETSTATUS:
492001a8319SHeiko Schocher 		/* We're MainfestationTolerant */
493001a8319SHeiko Schocher 		f_dfu->dfu_state = DFU_STATE_dfuIDLE;
494001a8319SHeiko Schocher 		handle_getstatus(req);
495001a8319SHeiko Schocher 		f_dfu->blk_seq_num = 0;
496001a8319SHeiko Schocher 		value = RET_STAT_LEN;
497001a8319SHeiko Schocher 		puts("DOWNLOAD ... OK\nCtrl+C to exit ...\n");
498001a8319SHeiko Schocher 		break;
499001a8319SHeiko Schocher 	case USB_REQ_DFU_GETSTATE:
500001a8319SHeiko Schocher 		handle_getstate(req);
501001a8319SHeiko Schocher 		break;
502001a8319SHeiko Schocher 	default:
503001a8319SHeiko Schocher 		f_dfu->dfu_state = DFU_STATE_dfuERROR;
504001a8319SHeiko Schocher 		value = RET_STALL;
505001a8319SHeiko Schocher 		break;
506001a8319SHeiko Schocher 	}
507001a8319SHeiko Schocher 	return value;
508001a8319SHeiko Schocher }
509001a8319SHeiko Schocher 
510b819ddbfSLukasz Majewski static int state_dfu_upload_idle(struct f_dfu *f_dfu,
511b819ddbfSLukasz Majewski 				 const struct usb_ctrlrequest *ctrl,
512b819ddbfSLukasz Majewski 				 struct usb_gadget *gadget,
513b819ddbfSLukasz Majewski 				 struct usb_request *req)
514b819ddbfSLukasz Majewski {
515b819ddbfSLukasz Majewski 	u16 w_value = le16_to_cpu(ctrl->wValue);
516b819ddbfSLukasz Majewski 	u16 len = le16_to_cpu(ctrl->wLength);
517b819ddbfSLukasz Majewski 	int value = 0;
518b819ddbfSLukasz Majewski 
519b819ddbfSLukasz Majewski 	switch (ctrl->bRequest) {
520b819ddbfSLukasz Majewski 	case USB_REQ_DFU_UPLOAD:
521b819ddbfSLukasz Majewski 		/* state transition if less data then requested */
522b819ddbfSLukasz Majewski 		f_dfu->blk_seq_num = w_value;
523b819ddbfSLukasz Majewski 		value = handle_upload(req, len);
524b819ddbfSLukasz Majewski 		if (value >= 0 && value < len)
525b819ddbfSLukasz Majewski 			f_dfu->dfu_state = DFU_STATE_dfuIDLE;
526b819ddbfSLukasz Majewski 		break;
527b819ddbfSLukasz Majewski 	case USB_REQ_DFU_ABORT:
528b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuIDLE;
529b819ddbfSLukasz Majewski 		/* no zlp? */
530b819ddbfSLukasz Majewski 		value = RET_ZLP;
531b819ddbfSLukasz Majewski 		break;
532b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATUS:
533b819ddbfSLukasz Majewski 		handle_getstatus(req);
534b819ddbfSLukasz Majewski 		value = RET_STAT_LEN;
535b819ddbfSLukasz Majewski 		break;
536b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATE:
537b819ddbfSLukasz Majewski 		handle_getstate(req);
538b819ddbfSLukasz Majewski 		break;
539b819ddbfSLukasz Majewski 	default:
540b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuERROR;
541b819ddbfSLukasz Majewski 		value = RET_STALL;
542b819ddbfSLukasz Majewski 		break;
543b819ddbfSLukasz Majewski 	}
544b819ddbfSLukasz Majewski 
545b819ddbfSLukasz Majewski 	return value;
546b819ddbfSLukasz Majewski }
547b819ddbfSLukasz Majewski 
548b819ddbfSLukasz Majewski static int state_dfu_error(struct f_dfu *f_dfu,
549b819ddbfSLukasz Majewski 				 const struct usb_ctrlrequest *ctrl,
550b819ddbfSLukasz Majewski 				 struct usb_gadget *gadget,
551b819ddbfSLukasz Majewski 				 struct usb_request *req)
552b819ddbfSLukasz Majewski {
553b819ddbfSLukasz Majewski 	int value = 0;
554b819ddbfSLukasz Majewski 
555b819ddbfSLukasz Majewski 	switch (ctrl->bRequest) {
556b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATUS:
557b819ddbfSLukasz Majewski 		handle_getstatus(req);
558b819ddbfSLukasz Majewski 		value = RET_STAT_LEN;
559b819ddbfSLukasz Majewski 		break;
560b819ddbfSLukasz Majewski 	case USB_REQ_DFU_GETSTATE:
561b819ddbfSLukasz Majewski 		handle_getstate(req);
562b819ddbfSLukasz Majewski 		break;
563b819ddbfSLukasz Majewski 	case USB_REQ_DFU_CLRSTATUS:
564b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuIDLE;
565b819ddbfSLukasz Majewski 		f_dfu->dfu_status = DFU_STATUS_OK;
566b819ddbfSLukasz Majewski 		/* no zlp? */
567b819ddbfSLukasz Majewski 		value = RET_ZLP;
568b819ddbfSLukasz Majewski 		break;
569b819ddbfSLukasz Majewski 	default:
570b819ddbfSLukasz Majewski 		f_dfu->dfu_state = DFU_STATE_dfuERROR;
571b819ddbfSLukasz Majewski 		value = RET_STALL;
572b819ddbfSLukasz Majewski 		break;
573b819ddbfSLukasz Majewski 	}
574b819ddbfSLukasz Majewski 
575b819ddbfSLukasz Majewski 	return value;
576b819ddbfSLukasz Majewski }
577b819ddbfSLukasz Majewski 
578b819ddbfSLukasz Majewski static dfu_state_fn dfu_state[] = {
579b819ddbfSLukasz Majewski 	state_app_idle,          /* DFU_STATE_appIDLE */
580b819ddbfSLukasz Majewski 	state_app_detach,        /* DFU_STATE_appDETACH */
581b819ddbfSLukasz Majewski 	state_dfu_idle,          /* DFU_STATE_dfuIDLE */
582b819ddbfSLukasz Majewski 	state_dfu_dnload_sync,   /* DFU_STATE_dfuDNLOAD_SYNC */
583b819ddbfSLukasz Majewski 	state_dfu_dnbusy,        /* DFU_STATE_dfuDNBUSY */
584b819ddbfSLukasz Majewski 	state_dfu_dnload_idle,   /* DFU_STATE_dfuDNLOAD_IDLE */
585b819ddbfSLukasz Majewski 	state_dfu_manifest_sync, /* DFU_STATE_dfuMANIFEST_SYNC */
586001a8319SHeiko Schocher 	state_dfu_manifest,	 /* DFU_STATE_dfuMANIFEST */
587b819ddbfSLukasz Majewski 	NULL,                    /* DFU_STATE_dfuMANIFEST_WAIT_RST */
588b819ddbfSLukasz Majewski 	state_dfu_upload_idle,   /* DFU_STATE_dfuUPLOAD_IDLE */
589b819ddbfSLukasz Majewski 	state_dfu_error          /* DFU_STATE_dfuERROR */
590b819ddbfSLukasz Majewski };
591b819ddbfSLukasz Majewski 
592b819ddbfSLukasz Majewski static int
593b819ddbfSLukasz Majewski dfu_handle(struct usb_function *f, const struct usb_ctrlrequest *ctrl)
594b819ddbfSLukasz Majewski {
595b819ddbfSLukasz Majewski 	struct usb_gadget *gadget = f->config->cdev->gadget;
596b819ddbfSLukasz Majewski 	struct usb_request *req = f->config->cdev->req;
597b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu = f->config->cdev->req->context;
598b819ddbfSLukasz Majewski 	u16 len = le16_to_cpu(ctrl->wLength);
599b819ddbfSLukasz Majewski 	u16 w_value = le16_to_cpu(ctrl->wValue);
600b819ddbfSLukasz Majewski 	int value = 0;
601b819ddbfSLukasz Majewski 	u8 req_type = ctrl->bRequestType & USB_TYPE_MASK;
602b819ddbfSLukasz Majewski 
603b819ddbfSLukasz Majewski 	debug("w_value: 0x%x len: 0x%x\n", w_value, len);
604b819ddbfSLukasz Majewski 	debug("req_type: 0x%x ctrl->bRequest: 0x%x f_dfu->dfu_state: 0x%x\n",
605b819ddbfSLukasz Majewski 	       req_type, ctrl->bRequest, f_dfu->dfu_state);
606b819ddbfSLukasz Majewski 
607b819ddbfSLukasz Majewski 	if (req_type == USB_TYPE_STANDARD) {
608b819ddbfSLukasz Majewski 		if (ctrl->bRequest == USB_REQ_GET_DESCRIPTOR &&
609b819ddbfSLukasz Majewski 		    (w_value >> 8) == DFU_DT_FUNC) {
610b819ddbfSLukasz Majewski 			value = min(len, (u16) sizeof(dfu_func));
611b819ddbfSLukasz Majewski 			memcpy(req->buf, &dfu_func, value);
612b819ddbfSLukasz Majewski 		}
613b819ddbfSLukasz Majewski 	} else /* DFU specific request */
614b819ddbfSLukasz Majewski 		value = dfu_state[f_dfu->dfu_state] (f_dfu, ctrl, gadget, req);
615b819ddbfSLukasz Majewski 
616b819ddbfSLukasz Majewski 	if (value >= 0) {
617b819ddbfSLukasz Majewski 		req->length = value;
618b819ddbfSLukasz Majewski 		req->zero = value < len;
619b819ddbfSLukasz Majewski 		value = usb_ep_queue(gadget->ep0, req, 0);
620b819ddbfSLukasz Majewski 		if (value < 0) {
621b819ddbfSLukasz Majewski 			debug("ep_queue --> %d\n", value);
622b819ddbfSLukasz Majewski 			req->status = 0;
623b819ddbfSLukasz Majewski 		}
624b819ddbfSLukasz Majewski 	}
625b819ddbfSLukasz Majewski 
626b819ddbfSLukasz Majewski 	return value;
627b819ddbfSLukasz Majewski }
628b819ddbfSLukasz Majewski 
629b819ddbfSLukasz Majewski /*-------------------------------------------------------------------------*/
630b819ddbfSLukasz Majewski 
631b819ddbfSLukasz Majewski static int
632b819ddbfSLukasz Majewski dfu_prepare_strings(struct f_dfu *f_dfu, int n)
633b819ddbfSLukasz Majewski {
634b819ddbfSLukasz Majewski 	struct dfu_entity *de = NULL;
635b819ddbfSLukasz Majewski 	int i = 0;
636b819ddbfSLukasz Majewski 
637b819ddbfSLukasz Majewski 	f_dfu->strings = calloc(sizeof(struct usb_string), n + 1);
638b819ddbfSLukasz Majewski 	if (!f_dfu->strings)
639*12ff19dbSPeng Fan 		return -ENOMEM;
640b819ddbfSLukasz Majewski 
641b819ddbfSLukasz Majewski 	for (i = 0; i < n; ++i) {
642b819ddbfSLukasz Majewski 		de = dfu_get_entity(i);
643b819ddbfSLukasz Majewski 		f_dfu->strings[i].s = de->name;
644b819ddbfSLukasz Majewski 	}
645b819ddbfSLukasz Majewski 
646b819ddbfSLukasz Majewski 	f_dfu->strings[i].id = 0;
647b819ddbfSLukasz Majewski 	f_dfu->strings[i].s = NULL;
648b819ddbfSLukasz Majewski 
649b819ddbfSLukasz Majewski 	return 0;
650b819ddbfSLukasz Majewski }
651b819ddbfSLukasz Majewski 
652b819ddbfSLukasz Majewski static int dfu_prepare_function(struct f_dfu *f_dfu, int n)
653b819ddbfSLukasz Majewski {
654b819ddbfSLukasz Majewski 	struct usb_interface_descriptor *d;
655b819ddbfSLukasz Majewski 	int i = 0;
656b819ddbfSLukasz Majewski 
657e059a400SLukasz Majewski 	f_dfu->function = calloc(sizeof(struct usb_descriptor_header *), n + 1);
658b819ddbfSLukasz Majewski 	if (!f_dfu->function)
659b819ddbfSLukasz Majewski 		goto enomem;
660b819ddbfSLukasz Majewski 
661b819ddbfSLukasz Majewski 	for (i = 0; i < n; ++i) {
662b819ddbfSLukasz Majewski 		d = calloc(sizeof(*d), 1);
663b819ddbfSLukasz Majewski 		if (!d)
664b819ddbfSLukasz Majewski 			goto enomem;
665b819ddbfSLukasz Majewski 
666b819ddbfSLukasz Majewski 		d->bLength =		sizeof(*d);
667b819ddbfSLukasz Majewski 		d->bDescriptorType =	USB_DT_INTERFACE;
668b819ddbfSLukasz Majewski 		d->bAlternateSetting =	i;
669b819ddbfSLukasz Majewski 		d->bNumEndpoints =	0;
670b819ddbfSLukasz Majewski 		d->bInterfaceClass =	USB_CLASS_APP_SPEC;
671b819ddbfSLukasz Majewski 		d->bInterfaceSubClass =	1;
672b819ddbfSLukasz Majewski 		d->bInterfaceProtocol =	2;
673b819ddbfSLukasz Majewski 
674b819ddbfSLukasz Majewski 		f_dfu->function[i] = (struct usb_descriptor_header *)d;
675b819ddbfSLukasz Majewski 	}
676b819ddbfSLukasz Majewski 	f_dfu->function[i] = NULL;
677b819ddbfSLukasz Majewski 
678b819ddbfSLukasz Majewski 	return 0;
679b819ddbfSLukasz Majewski 
680b819ddbfSLukasz Majewski enomem:
681b819ddbfSLukasz Majewski 	while (i) {
682b819ddbfSLukasz Majewski 		free(f_dfu->function[--i]);
683b819ddbfSLukasz Majewski 		f_dfu->function[i] = NULL;
684b819ddbfSLukasz Majewski 	}
685b819ddbfSLukasz Majewski 	free(f_dfu->function);
686b819ddbfSLukasz Majewski 
687b819ddbfSLukasz Majewski 	return -ENOMEM;
688b819ddbfSLukasz Majewski }
689b819ddbfSLukasz Majewski 
690b819ddbfSLukasz Majewski static int dfu_bind(struct usb_configuration *c, struct usb_function *f)
691b819ddbfSLukasz Majewski {
692b819ddbfSLukasz Majewski 	struct usb_composite_dev *cdev = c->cdev;
693b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu = func_to_dfu(f);
694b819ddbfSLukasz Majewski 	int alt_num = dfu_get_alt_number();
695b819ddbfSLukasz Majewski 	int rv, id, i;
696b819ddbfSLukasz Majewski 
697b819ddbfSLukasz Majewski 	id = usb_interface_id(c, f);
698b819ddbfSLukasz Majewski 	if (id < 0)
699b819ddbfSLukasz Majewski 		return id;
700b819ddbfSLukasz Majewski 	dfu_intf_runtime.bInterfaceNumber = id;
701b819ddbfSLukasz Majewski 
702b819ddbfSLukasz Majewski 	f_dfu->dfu_state = DFU_STATE_appIDLE;
703b819ddbfSLukasz Majewski 	f_dfu->dfu_status = DFU_STATUS_OK;
704b819ddbfSLukasz Majewski 
705b819ddbfSLukasz Majewski 	rv = dfu_prepare_function(f_dfu, alt_num);
706b819ddbfSLukasz Majewski 	if (rv)
707b819ddbfSLukasz Majewski 		goto error;
708b819ddbfSLukasz Majewski 
709b819ddbfSLukasz Majewski 	rv = dfu_prepare_strings(f_dfu, alt_num);
710b819ddbfSLukasz Majewski 	if (rv)
711b819ddbfSLukasz Majewski 		goto error;
712b819ddbfSLukasz Majewski 	for (i = 0; i < alt_num; i++) {
713b819ddbfSLukasz Majewski 		id = usb_string_id(cdev);
714b819ddbfSLukasz Majewski 		if (id < 0)
715b819ddbfSLukasz Majewski 			return id;
716b819ddbfSLukasz Majewski 		f_dfu->strings[i].id = id;
717b819ddbfSLukasz Majewski 		((struct usb_interface_descriptor *)f_dfu->function[i])
718b819ddbfSLukasz Majewski 			->iInterface = id;
719b819ddbfSLukasz Majewski 	}
720b819ddbfSLukasz Majewski 
721ad5f9778SHeiko Schocher 	to_dfu_mode(f_dfu);
722ad5f9778SHeiko Schocher 
723b819ddbfSLukasz Majewski 	stringtab_dfu.strings = f_dfu->strings;
724b819ddbfSLukasz Majewski 
725b819ddbfSLukasz Majewski 	cdev->req->context = f_dfu;
726b819ddbfSLukasz Majewski 
727b819ddbfSLukasz Majewski error:
728b819ddbfSLukasz Majewski 	return rv;
729b819ddbfSLukasz Majewski }
730b819ddbfSLukasz Majewski 
731b819ddbfSLukasz Majewski static void dfu_unbind(struct usb_configuration *c, struct usb_function *f)
732b819ddbfSLukasz Majewski {
733b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu = func_to_dfu(f);
734b819ddbfSLukasz Majewski 	int alt_num = dfu_get_alt_number();
735b819ddbfSLukasz Majewski 	int i;
736b819ddbfSLukasz Majewski 
737b819ddbfSLukasz Majewski 	if (f_dfu->strings) {
738b819ddbfSLukasz Majewski 		i = alt_num;
739b819ddbfSLukasz Majewski 		while (i)
740b819ddbfSLukasz Majewski 			f_dfu->strings[--i].s = NULL;
741b819ddbfSLukasz Majewski 
742b819ddbfSLukasz Majewski 		free(f_dfu->strings);
743b819ddbfSLukasz Majewski 	}
744b819ddbfSLukasz Majewski 
745b819ddbfSLukasz Majewski 	if (f_dfu->function) {
746b819ddbfSLukasz Majewski 		i = alt_num;
747b819ddbfSLukasz Majewski 		while (i) {
748b819ddbfSLukasz Majewski 			free(f_dfu->function[--i]);
749b819ddbfSLukasz Majewski 			f_dfu->function[i] = NULL;
750b819ddbfSLukasz Majewski 		}
751b819ddbfSLukasz Majewski 		free(f_dfu->function);
752b819ddbfSLukasz Majewski 	}
753b819ddbfSLukasz Majewski 
754b819ddbfSLukasz Majewski 	free(f_dfu);
755b819ddbfSLukasz Majewski }
756b819ddbfSLukasz Majewski 
757b819ddbfSLukasz Majewski static int dfu_set_alt(struct usb_function *f, unsigned intf, unsigned alt)
758b819ddbfSLukasz Majewski {
759b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu = func_to_dfu(f);
760b819ddbfSLukasz Majewski 
761b819ddbfSLukasz Majewski 	debug("%s: intf:%d alt:%d\n", __func__, intf, alt);
762b819ddbfSLukasz Majewski 
763b819ddbfSLukasz Majewski 	f_dfu->altsetting = alt;
7643ee9593fSStephen Warren 	f_dfu->dfu_state = DFU_STATE_dfuIDLE;
7653ee9593fSStephen Warren 	f_dfu->dfu_status = DFU_STATUS_OK;
766b819ddbfSLukasz Majewski 
767b819ddbfSLukasz Majewski 	return 0;
768b819ddbfSLukasz Majewski }
769b819ddbfSLukasz Majewski 
7701fd81b7cSStefan Roese static int __dfu_get_alt(struct usb_function *f, unsigned intf)
7711fd81b7cSStefan Roese {
7721fd81b7cSStefan Roese 	struct f_dfu *f_dfu = func_to_dfu(f);
7731fd81b7cSStefan Roese 
7741fd81b7cSStefan Roese 	return f_dfu->altsetting;
7751fd81b7cSStefan Roese }
7761fd81b7cSStefan Roese 
777b819ddbfSLukasz Majewski /* TODO: is this really what we need here? */
778b819ddbfSLukasz Majewski static void dfu_disable(struct usb_function *f)
779b819ddbfSLukasz Majewski {
780b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu = func_to_dfu(f);
781b819ddbfSLukasz Majewski 	if (f_dfu->config == 0)
782b819ddbfSLukasz Majewski 		return;
783b819ddbfSLukasz Majewski 
784b819ddbfSLukasz Majewski 	debug("%s: reset config\n", __func__);
785b819ddbfSLukasz Majewski 
786b819ddbfSLukasz Majewski 	f_dfu->config = 0;
787b819ddbfSLukasz Majewski }
788b819ddbfSLukasz Majewski 
789b819ddbfSLukasz Majewski static int dfu_bind_config(struct usb_configuration *c)
790b819ddbfSLukasz Majewski {
791b819ddbfSLukasz Majewski 	struct f_dfu *f_dfu;
792b819ddbfSLukasz Majewski 	int status;
793b819ddbfSLukasz Majewski 
794b819ddbfSLukasz Majewski 	f_dfu = calloc(sizeof(*f_dfu), 1);
795b819ddbfSLukasz Majewski 	if (!f_dfu)
796b819ddbfSLukasz Majewski 		return -ENOMEM;
797b819ddbfSLukasz Majewski 	f_dfu->usb_function.name = "dfu";
798b819ddbfSLukasz Majewski 	f_dfu->usb_function.hs_descriptors = dfu_runtime_descs;
7999f3b8ed1SHeiko Schocher 	f_dfu->usb_function.descriptors = dfu_runtime_descs;
800b819ddbfSLukasz Majewski 	f_dfu->usb_function.bind = dfu_bind;
801b819ddbfSLukasz Majewski 	f_dfu->usb_function.unbind = dfu_unbind;
802b819ddbfSLukasz Majewski 	f_dfu->usb_function.set_alt = dfu_set_alt;
8031fd81b7cSStefan Roese 	f_dfu->usb_function.get_alt = __dfu_get_alt;
804b819ddbfSLukasz Majewski 	f_dfu->usb_function.disable = dfu_disable;
80577b95042SLukasz Majewski 	f_dfu->usb_function.strings = dfu_generic_strings;
80677b95042SLukasz Majewski 	f_dfu->usb_function.setup = dfu_handle;
80733fac4a6SLukasz Majewski 	f_dfu->poll_timeout = DFU_DEFAULT_POLL_TIMEOUT;
808b819ddbfSLukasz Majewski 
809b819ddbfSLukasz Majewski 	status = usb_add_function(c, &f_dfu->usb_function);
810b819ddbfSLukasz Majewski 	if (status)
811b819ddbfSLukasz Majewski 		free(f_dfu);
812b819ddbfSLukasz Majewski 
813b819ddbfSLukasz Majewski 	return status;
814b819ddbfSLukasz Majewski }
815b819ddbfSLukasz Majewski 
816b819ddbfSLukasz Majewski int dfu_add(struct usb_configuration *c)
817b819ddbfSLukasz Majewski {
818b819ddbfSLukasz Majewski 	int id;
819b819ddbfSLukasz Majewski 
820b819ddbfSLukasz Majewski 	id = usb_string_id(c->cdev);
821b819ddbfSLukasz Majewski 	if (id < 0)
822b819ddbfSLukasz Majewski 		return id;
823b819ddbfSLukasz Majewski 	strings_dfu_generic[0].id = id;
824b819ddbfSLukasz Majewski 	dfu_intf_runtime.iInterface = id;
825b819ddbfSLukasz Majewski 
826b819ddbfSLukasz Majewski 	debug("%s: cdev: 0x%p gadget:0x%p gadget->ep0: 0x%p\n", __func__,
827b819ddbfSLukasz Majewski 	       c->cdev, c->cdev->gadget, c->cdev->gadget->ep0);
828b819ddbfSLukasz Majewski 
829b819ddbfSLukasz Majewski 	return dfu_bind_config(c);
830b819ddbfSLukasz Majewski }
831c4d0e856SMateusz Zalega 
832c4d0e856SMateusz Zalega DECLARE_GADGET_BIND_CALLBACK(usb_dnl_dfu, dfu_add);
833