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