blob: 574d61058081f514fe8dbc2dceec10cc528b8053 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Eddie Caibf2b72b2017-12-15 08:17:10 +08002/*
3 * (C) Copyright 2017
4 *
5 * Eddie Cai <eddie.cai.linux@gmail.com>
Eddie Caibf2b72b2017-12-15 08:17:10 +08006 */
7#include <config.h>
8#include <common.h>
9#include <errno.h>
10#include <malloc.h>
11#include <memalign.h>
12#include <linux/usb/ch9.h>
13#include <linux/usb/gadget.h>
14#include <linux/usb/composite.h>
15#include <linux/compiler.h>
16#include <version.h>
17#include <g_dnl.h>
18#include <asm/arch/f_rockusb.h>
19
20static inline struct f_rockusb *func_to_rockusb(struct usb_function *f)
21{
22 return container_of(f, struct f_rockusb, usb_function);
23}
24
25static struct usb_endpoint_descriptor fs_ep_in = {
26 .bLength = USB_DT_ENDPOINT_SIZE,
27 .bDescriptorType = USB_DT_ENDPOINT,
28 .bEndpointAddress = USB_DIR_IN,
29 .bmAttributes = USB_ENDPOINT_XFER_BULK,
30 .wMaxPacketSize = cpu_to_le16(64),
31};
32
33static struct usb_endpoint_descriptor fs_ep_out = {
34 .bLength = USB_DT_ENDPOINT_SIZE,
35 .bDescriptorType = USB_DT_ENDPOINT,
36 .bEndpointAddress = USB_DIR_OUT,
37 .bmAttributes = USB_ENDPOINT_XFER_BULK,
38 .wMaxPacketSize = cpu_to_le16(64),
39};
40
41static struct usb_endpoint_descriptor hs_ep_in = {
42 .bLength = USB_DT_ENDPOINT_SIZE,
43 .bDescriptorType = USB_DT_ENDPOINT,
44 .bEndpointAddress = USB_DIR_IN,
45 .bmAttributes = USB_ENDPOINT_XFER_BULK,
46 .wMaxPacketSize = cpu_to_le16(512),
47};
48
49static struct usb_endpoint_descriptor hs_ep_out = {
50 .bLength = USB_DT_ENDPOINT_SIZE,
51 .bDescriptorType = USB_DT_ENDPOINT,
52 .bEndpointAddress = USB_DIR_OUT,
53 .bmAttributes = USB_ENDPOINT_XFER_BULK,
54 .wMaxPacketSize = cpu_to_le16(512),
55};
56
57static struct usb_interface_descriptor interface_desc = {
58 .bLength = USB_DT_INTERFACE_SIZE,
59 .bDescriptorType = USB_DT_INTERFACE,
60 .bInterfaceNumber = 0x00,
61 .bAlternateSetting = 0x00,
62 .bNumEndpoints = 0x02,
63 .bInterfaceClass = ROCKUSB_INTERFACE_CLASS,
64 .bInterfaceSubClass = ROCKUSB_INTERFACE_SUB_CLASS,
65 .bInterfaceProtocol = ROCKUSB_INTERFACE_PROTOCOL,
66};
67
68static struct usb_descriptor_header *rkusb_fs_function[] = {
69 (struct usb_descriptor_header *)&interface_desc,
70 (struct usb_descriptor_header *)&fs_ep_in,
71 (struct usb_descriptor_header *)&fs_ep_out,
72};
73
74static struct usb_descriptor_header *rkusb_hs_function[] = {
75 (struct usb_descriptor_header *)&interface_desc,
76 (struct usb_descriptor_header *)&hs_ep_in,
77 (struct usb_descriptor_header *)&hs_ep_out,
78 NULL,
79};
80
81static const char rkusb_name[] = "Rockchip Rockusb";
82
83static struct usb_string rkusb_string_defs[] = {
84 [0].s = rkusb_name,
85 { } /* end of list */
86};
87
88static struct usb_gadget_strings stringtab_rkusb = {
89 .language = 0x0409, /* en-us */
90 .strings = rkusb_string_defs,
91};
92
93static struct usb_gadget_strings *rkusb_strings[] = {
94 &stringtab_rkusb,
95 NULL,
96};
97
98static struct f_rockusb *rockusb_func;
99static void rx_handler_command(struct usb_ep *ep, struct usb_request *req);
100static int rockusb_tx_write_csw(u32 tag, int residue, u8 status, int size);
101
102struct f_rockusb *get_rkusb(void)
103{
104 struct f_rockusb *f_rkusb = rockusb_func;
105
106 if (!f_rkusb) {
107 f_rkusb = memalign(CONFIG_SYS_CACHELINE_SIZE, sizeof(*f_rkusb));
108 if (!f_rkusb)
109 return 0;
110
111 rockusb_func = f_rkusb;
112 memset(f_rkusb, 0, sizeof(*f_rkusb));
113 }
114
115 if (!f_rkusb->buf_head) {
116 f_rkusb->buf_head = memalign(CONFIG_SYS_CACHELINE_SIZE,
117 RKUSB_BUF_SIZE);
118 if (!f_rkusb->buf_head)
119 return 0;
120
121 f_rkusb->buf = f_rkusb->buf_head;
122 memset(f_rkusb->buf_head, 0, RKUSB_BUF_SIZE);
123 }
124 return f_rkusb;
125}
126
127static struct usb_endpoint_descriptor *rkusb_ep_desc(
128struct usb_gadget *g,
129struct usb_endpoint_descriptor *fs,
130struct usb_endpoint_descriptor *hs)
131{
132 if (gadget_is_dualspeed(g) && g->speed == USB_SPEED_HIGH)
133 return hs;
134 return fs;
135}
136
137static void rockusb_complete(struct usb_ep *ep, struct usb_request *req)
138{
139 int status = req->status;
140
141 if (!status)
142 return;
143 debug("status: %d ep '%s' trans: %d\n", status, ep->name, req->actual);
144}
145
146/* config the rockusb device*/
147static int rockusb_bind(struct usb_configuration *c, struct usb_function *f)
148{
149 int id;
150 struct usb_gadget *gadget = c->cdev->gadget;
151 struct f_rockusb *f_rkusb = func_to_rockusb(f);
152 const char *s;
153
154 id = usb_interface_id(c, f);
155 if (id < 0)
156 return id;
157 interface_desc.bInterfaceNumber = id;
158
159 id = usb_string_id(c->cdev);
160 if (id < 0)
161 return id;
162
163 rkusb_string_defs[0].id = id;
164 interface_desc.iInterface = id;
165
166 f_rkusb->in_ep = usb_ep_autoconfig(gadget, &fs_ep_in);
167 if (!f_rkusb->in_ep)
168 return -ENODEV;
169 f_rkusb->in_ep->driver_data = c->cdev;
170
171 f_rkusb->out_ep = usb_ep_autoconfig(gadget, &fs_ep_out);
172 if (!f_rkusb->out_ep)
173 return -ENODEV;
174 f_rkusb->out_ep->driver_data = c->cdev;
175
176 f->descriptors = rkusb_fs_function;
177
178 if (gadget_is_dualspeed(gadget)) {
179 hs_ep_in.bEndpointAddress = fs_ep_in.bEndpointAddress;
180 hs_ep_out.bEndpointAddress = fs_ep_out.bEndpointAddress;
181 f->hs_descriptors = rkusb_hs_function;
182 }
183
184 s = env_get("serial#");
185 if (s)
186 g_dnl_set_serialnumber((char *)s);
187
188 return 0;
189}
190
191static void rockusb_unbind(struct usb_configuration *c, struct usb_function *f)
192{
193 /* clear the configuration*/
194 memset(rockusb_func, 0, sizeof(*rockusb_func));
195}
196
197static void rockusb_disable(struct usb_function *f)
198{
199 struct f_rockusb *f_rkusb = func_to_rockusb(f);
200
201 usb_ep_disable(f_rkusb->out_ep);
202 usb_ep_disable(f_rkusb->in_ep);
203
204 if (f_rkusb->out_req) {
205 free(f_rkusb->out_req->buf);
206 usb_ep_free_request(f_rkusb->out_ep, f_rkusb->out_req);
207 f_rkusb->out_req = NULL;
208 }
209 if (f_rkusb->in_req) {
210 free(f_rkusb->in_req->buf);
211 usb_ep_free_request(f_rkusb->in_ep, f_rkusb->in_req);
212 f_rkusb->in_req = NULL;
213 }
214 if (f_rkusb->buf_head) {
215 free(f_rkusb->buf_head);
216 f_rkusb->buf_head = NULL;
217 f_rkusb->buf = NULL;
218 }
219}
220
221static struct usb_request *rockusb_start_ep(struct usb_ep *ep)
222{
223 struct usb_request *req;
224
225 req = usb_ep_alloc_request(ep, 0);
226 if (!req)
227 return NULL;
228
229 req->length = EP_BUFFER_SIZE;
230 req->buf = memalign(CONFIG_SYS_CACHELINE_SIZE, EP_BUFFER_SIZE);
231 if (!req->buf) {
232 usb_ep_free_request(ep, req);
233 return NULL;
234 }
235 memset(req->buf, 0, req->length);
236
237 return req;
238}
239
240static int rockusb_set_alt(struct usb_function *f, unsigned int interface,
241 unsigned int alt)
242{
243 int ret;
244 struct usb_composite_dev *cdev = f->config->cdev;
245 struct usb_gadget *gadget = cdev->gadget;
246 struct f_rockusb *f_rkusb = func_to_rockusb(f);
247 const struct usb_endpoint_descriptor *d;
248
249 debug("%s: func: %s intf: %d alt: %d\n",
250 __func__, f->name, interface, alt);
251
252 d = rkusb_ep_desc(gadget, &fs_ep_out, &hs_ep_out);
253 ret = usb_ep_enable(f_rkusb->out_ep, d);
254 if (ret) {
255 printf("failed to enable out ep\n");
256 return ret;
257 }
258
259 f_rkusb->out_req = rockusb_start_ep(f_rkusb->out_ep);
260 if (!f_rkusb->out_req) {
261 printf("failed to alloc out req\n");
262 ret = -EINVAL;
263 goto err;
264 }
265 f_rkusb->out_req->complete = rx_handler_command;
266
267 d = rkusb_ep_desc(gadget, &fs_ep_in, &hs_ep_in);
268 ret = usb_ep_enable(f_rkusb->in_ep, d);
269 if (ret) {
270 printf("failed to enable in ep\n");
271 goto err;
272 }
273
274 f_rkusb->in_req = rockusb_start_ep(f_rkusb->in_ep);
275 if (!f_rkusb->in_req) {
276 printf("failed alloc req in\n");
277 ret = -EINVAL;
278 goto err;
279 }
280 f_rkusb->in_req->complete = rockusb_complete;
281
282 ret = usb_ep_queue(f_rkusb->out_ep, f_rkusb->out_req, 0);
283 if (ret)
284 goto err;
285
286 return 0;
287err:
288 rockusb_disable(f);
289 return ret;
290}
291
292static int rockusb_add(struct usb_configuration *c)
293{
294 struct f_rockusb *f_rkusb = get_rkusb();
295 int status;
296
297 debug("%s: cdev: 0x%p\n", __func__, c->cdev);
298
299 f_rkusb->usb_function.name = "f_rockusb";
300 f_rkusb->usb_function.bind = rockusb_bind;
301 f_rkusb->usb_function.unbind = rockusb_unbind;
302 f_rkusb->usb_function.set_alt = rockusb_set_alt;
303 f_rkusb->usb_function.disable = rockusb_disable;
304 f_rkusb->usb_function.strings = rkusb_strings;
305
306 status = usb_add_function(c, &f_rkusb->usb_function);
307 if (status) {
308 free(f_rkusb);
309 rockusb_func = f_rkusb;
310 }
311 return status;
312}
313
314void rockusb_dev_init(char *dev_type, int dev_index)
315{
316 struct f_rockusb *f_rkusb = get_rkusb();
317
318 f_rkusb->dev_type = dev_type;
319 f_rkusb->dev_index = dev_index;
320}
321
322DECLARE_GADGET_BIND_CALLBACK(usb_dnl_rockusb, rockusb_add);
323
324static int rockusb_tx_write(const char *buffer, unsigned int buffer_size)
325{
326 struct usb_request *in_req = rockusb_func->in_req;
327 int ret;
328
329 memcpy(in_req->buf, buffer, buffer_size);
330 in_req->length = buffer_size;
Alberto Panizzoe11f9162018-07-12 13:05:44 +0200331 debug("Transferring 0x%x bytes\n", buffer_size);
Eddie Caibf2b72b2017-12-15 08:17:10 +0800332 usb_ep_dequeue(rockusb_func->in_ep, in_req);
333 ret = usb_ep_queue(rockusb_func->in_ep, in_req, 0);
334 if (ret)
335 printf("Error %d on queue\n", ret);
336 return 0;
337}
338
339static int rockusb_tx_write_str(const char *buffer)
340{
341 return rockusb_tx_write(buffer, strlen(buffer));
342}
343
344#ifdef DEBUG
345static void printcbw(char *buf)
346{
347 ALLOC_CACHE_ALIGN_BUFFER(struct fsg_bulk_cb_wrap, cbw,
348 sizeof(struct fsg_bulk_cb_wrap));
349
350 memcpy((char *)cbw, buf, USB_BULK_CB_WRAP_LEN);
351
352 debug("cbw: signature:%x\n", cbw->signature);
353 debug("cbw: tag=%x\n", cbw->tag);
354 debug("cbw: data_transfer_length=%d\n", cbw->data_transfer_length);
355 debug("cbw: flags=%x\n", cbw->flags);
356 debug("cbw: lun=%d\n", cbw->lun);
357 debug("cbw: length=%d\n", cbw->length);
358 debug("cbw: ucOperCode=%x\n", cbw->CDB[0]);
359 debug("cbw: ucReserved=%x\n", cbw->CDB[1]);
360 debug("cbw: dwAddress:%x %x %x %x\n", cbw->CDB[5], cbw->CDB[4],
361 cbw->CDB[3], cbw->CDB[2]);
362 debug("cbw: ucReserved2=%x\n", cbw->CDB[6]);
363 debug("cbw: uslength:%x %x\n", cbw->CDB[8], cbw->CDB[7]);
364}
365
366static void printcsw(char *buf)
367{
368 ALLOC_CACHE_ALIGN_BUFFER(struct bulk_cs_wrap, csw,
369 sizeof(struct bulk_cs_wrap));
370 memcpy((char *)csw, buf, USB_BULK_CS_WRAP_LEN);
371 debug("csw: signature:%x\n", csw->signature);
372 debug("csw: tag:%x\n", csw->tag);
373 debug("csw: residue:%x\n", csw->residue);
374 debug("csw: status:%x\n", csw->status);
375}
376#endif
377
378static int rockusb_tx_write_csw(u32 tag, int residue, u8 status, int size)
379{
380 ALLOC_CACHE_ALIGN_BUFFER(struct bulk_cs_wrap, csw,
381 sizeof(struct bulk_cs_wrap));
382 csw->signature = cpu_to_le32(USB_BULK_CS_SIG);
383 csw->tag = tag;
384 csw->residue = cpu_to_be32(residue);
385 csw->status = status;
386#ifdef DEBUG
Alberto Panizzo4f6dc4c2018-07-12 13:05:48 +0200387 printcsw((char *)csw);
Eddie Caibf2b72b2017-12-15 08:17:10 +0800388#endif
389 return rockusb_tx_write((char *)csw, size);
390}
391
Alberto Panizzocad66e32018-07-12 13:05:41 +0200392static void tx_handler_send_csw(struct usb_ep *ep, struct usb_request *req)
393{
394 struct f_rockusb *f_rkusb = get_rkusb();
395 int status = req->status;
396
397 if (status)
398 debug("status: %d ep '%s' trans: %d\n",
399 status, ep->name, req->actual);
400
401 /* Return back to default in_req complete function after sending CSW */
402 req->complete = rockusb_complete;
403 rockusb_tx_write_csw(f_rkusb->tag, 0, CSW_GOOD, USB_BULK_CS_WRAP_LEN);
404}
405
Eddie Caibf2b72b2017-12-15 08:17:10 +0800406static unsigned int rx_bytes_expected(struct usb_ep *ep)
407{
408 struct f_rockusb *f_rkusb = get_rkusb();
409 int rx_remain = f_rkusb->dl_size - f_rkusb->dl_bytes;
410 unsigned int rem;
411 unsigned int maxpacket = ep->maxpacket;
412
413 if (rx_remain <= 0)
414 return 0;
415 else if (rx_remain > EP_BUFFER_SIZE)
416 return EP_BUFFER_SIZE;
417
418 rem = rx_remain % maxpacket;
419 if (rem > 0)
420 rx_remain = rx_remain + (maxpacket - rem);
421
422 return rx_remain;
423}
424
Alberto Panizzoe11f9162018-07-12 13:05:44 +0200425/* usb_request complete call back to handle upload image */
426static void tx_handler_ul_image(struct usb_ep *ep, struct usb_request *req)
427{
428 ALLOC_CACHE_ALIGN_BUFFER(char, rbuffer, RKBLOCK_BUF_SIZE);
429 struct f_rockusb *f_rkusb = get_rkusb();
430 struct usb_request *in_req = rockusb_func->in_req;
431 int ret;
432
433 /* Print error status of previous transfer */
434 if (req->status)
435 debug("status: %d ep '%s' trans: %d len %d\n", req->status,
436 ep->name, req->actual, req->length);
437
438 /* On transfer complete reset in_req and feedback host with CSW_GOOD */
439 if (f_rkusb->ul_bytes >= f_rkusb->ul_size) {
440 in_req->length = 0;
441 in_req->complete = rockusb_complete;
442
443 rockusb_tx_write_csw(f_rkusb->tag, 0, CSW_GOOD,
444 USB_BULK_CS_WRAP_LEN);
445 return;
446 }
447
448 /* Proceed with current chunk */
449 unsigned int transfer_size = f_rkusb->ul_size - f_rkusb->ul_bytes;
450
451 if (transfer_size > RKBLOCK_BUF_SIZE)
452 transfer_size = RKBLOCK_BUF_SIZE;
453 /* Read at least one block */
454 unsigned int blkcount = (transfer_size + f_rkusb->desc->blksz - 1) /
455 f_rkusb->desc->blksz;
456
457 debug("ul %x bytes, %x blks, read lba %x, ul_size:%x, ul_bytes:%x, ",
458 transfer_size, blkcount, f_rkusb->lba,
459 f_rkusb->ul_size, f_rkusb->ul_bytes);
460
461 int blks = blk_dread(f_rkusb->desc, f_rkusb->lba, blkcount, rbuffer);
462
463 if (blks != blkcount) {
464 printf("failed reading from device %s: %d\n",
465 f_rkusb->dev_type, f_rkusb->dev_index);
466 rockusb_tx_write_csw(f_rkusb->tag, 0, CSW_FAIL,
467 USB_BULK_CS_WRAP_LEN);
468 return;
469 }
470 f_rkusb->lba += blkcount;
471 f_rkusb->ul_bytes += transfer_size;
472
473 /* Proceed with USB request */
474 memcpy(in_req->buf, rbuffer, transfer_size);
475 in_req->length = transfer_size;
476 in_req->complete = tx_handler_ul_image;
Alberto Panizzo11758a52018-07-12 13:05:46 +0200477 debug("Uploading 0x%x bytes\n", transfer_size);
Alberto Panizzoe11f9162018-07-12 13:05:44 +0200478 usb_ep_dequeue(rockusb_func->in_ep, in_req);
479 ret = usb_ep_queue(rockusb_func->in_ep, in_req, 0);
480 if (ret)
481 printf("Error %d on queue\n", ret);
482}
483
Eddie Caibf2b72b2017-12-15 08:17:10 +0800484/* usb_request complete call back to handle down load image */
485static void rx_handler_dl_image(struct usb_ep *ep, struct usb_request *req)
486{
487 struct f_rockusb *f_rkusb = get_rkusb();
488 unsigned int transfer_size = 0;
489 const unsigned char *buffer = req->buf;
490 unsigned int buffer_size = req->actual;
491
492 transfer_size = f_rkusb->dl_size - f_rkusb->dl_bytes;
493 if (!f_rkusb->desc) {
494 char *type = f_rkusb->dev_type;
495 int index = f_rkusb->dev_index;
496
497 f_rkusb->desc = blk_get_dev(type, index);
498 if (!f_rkusb->desc ||
499 f_rkusb->desc->type == DEV_TYPE_UNKNOWN) {
500 puts("invalid mmc device\n");
501 rockusb_tx_write_csw(f_rkusb->tag, 0, CSW_FAIL,
502 USB_BULK_CS_WRAP_LEN);
503 return;
504 }
505 }
506
507 if (req->status != 0) {
508 printf("Bad status: %d\n", req->status);
509 rockusb_tx_write_csw(f_rkusb->tag, 0, CSW_FAIL,
510 USB_BULK_CS_WRAP_LEN);
511 return;
512 }
513
514 if (buffer_size < transfer_size)
515 transfer_size = buffer_size;
516
517 memcpy((void *)f_rkusb->buf, buffer, transfer_size);
518 f_rkusb->dl_bytes += transfer_size;
519 int blks = 0, blkcnt = transfer_size / 512;
520
521 debug("dl %x bytes, %x blks, write lba %x, dl_size:%x, dl_bytes:%x, ",
522 transfer_size, blkcnt, f_rkusb->lba, f_rkusb->dl_size,
523 f_rkusb->dl_bytes);
524 blks = blk_dwrite(f_rkusb->desc, f_rkusb->lba, blkcnt, f_rkusb->buf);
525 if (blks != blkcnt) {
526 printf("failed writing to device %s: %d\n", f_rkusb->dev_type,
527 f_rkusb->dev_index);
528 rockusb_tx_write_csw(f_rkusb->tag, 0, CSW_FAIL,
529 USB_BULK_CS_WRAP_LEN);
530 return;
531 }
532 f_rkusb->lba += blkcnt;
533
534 /* Check if transfer is done */
535 if (f_rkusb->dl_bytes >= f_rkusb->dl_size) {
536 req->complete = rx_handler_command;
537 req->length = EP_BUFFER_SIZE;
538 f_rkusb->buf = f_rkusb->buf_head;
Alberto Panizzo11758a52018-07-12 13:05:46 +0200539 debug("transfer 0x%x bytes done\n", f_rkusb->dl_size);
Eddie Caibf2b72b2017-12-15 08:17:10 +0800540 f_rkusb->dl_size = 0;
541 rockusb_tx_write_csw(f_rkusb->tag, 0, CSW_GOOD,
542 USB_BULK_CS_WRAP_LEN);
543 } else {
544 req->length = rx_bytes_expected(ep);
545 if (f_rkusb->buf == f_rkusb->buf_head)
546 f_rkusb->buf = f_rkusb->buf_head + EP_BUFFER_SIZE;
547 else
548 f_rkusb->buf = f_rkusb->buf_head;
549
550 debug("remain %x bytes, %x sectors\n", req->length,
551 req->length / 512);
552 }
553
554 req->actual = 0;
555 usb_ep_queue(ep, req, 0);
556}
557
558static void cb_test_unit_ready(struct usb_ep *ep, struct usb_request *req)
559{
560 ALLOC_CACHE_ALIGN_BUFFER(struct fsg_bulk_cb_wrap, cbw,
561 sizeof(struct fsg_bulk_cb_wrap));
562
563 memcpy((char *)cbw, req->buf, USB_BULK_CB_WRAP_LEN);
564
565 rockusb_tx_write_csw(cbw->tag, cbw->data_transfer_length,
566 CSW_GOOD, USB_BULK_CS_WRAP_LEN);
567}
568
569static void cb_read_storage_id(struct usb_ep *ep, struct usb_request *req)
570{
571 ALLOC_CACHE_ALIGN_BUFFER(struct fsg_bulk_cb_wrap, cbw,
572 sizeof(struct fsg_bulk_cb_wrap));
Alberto Panizzocad66e32018-07-12 13:05:41 +0200573 struct f_rockusb *f_rkusb = get_rkusb();
Eddie Caibf2b72b2017-12-15 08:17:10 +0800574 char emmc_id[] = "EMMC ";
575
576 printf("read storage id\n");
577 memcpy((char *)cbw, req->buf, USB_BULK_CB_WRAP_LEN);
Alberto Panizzocad66e32018-07-12 13:05:41 +0200578
579 /* Prepare for sending subsequent CSW_GOOD */
580 f_rkusb->tag = cbw->tag;
581 f_rkusb->in_req->complete = tx_handler_send_csw;
582
Eddie Caibf2b72b2017-12-15 08:17:10 +0800583 rockusb_tx_write_str(emmc_id);
Eddie Caibf2b72b2017-12-15 08:17:10 +0800584}
585
Alberto Panizzoe4b34a72018-07-12 13:05:42 +0200586int __weak rk_get_bootrom_chip_version(unsigned int *chip_info, int size)
587{
588 return 0;
589}
590
591static void cb_get_chip_version(struct usb_ep *ep, struct usb_request *req)
592{
593 ALLOC_CACHE_ALIGN_BUFFER(struct fsg_bulk_cb_wrap, cbw,
594 sizeof(struct fsg_bulk_cb_wrap));
595 struct f_rockusb *f_rkusb = get_rkusb();
596 unsigned int chip_info[4], i;
597
598 memset(chip_info, 0, sizeof(chip_info));
599 rk_get_bootrom_chip_version(chip_info, 4);
600
601 /*
602 * Chip Version is a string saved in BOOTROM address space Little Endian
603 *
604 * Ex for rk3288: 0x33323041 0x32303134 0x30383133 0x56323030
605 * which brings: 320A20140813V200
606 *
607 * Note that memory version do invert MSB/LSB so printing the char
608 * buffer will show: A02341023180002V
609 */
610 printf("read chip version: ");
611 for (i = 0; i < 4; i++) {
612 printf("%c%c%c%c",
613 (chip_info[i] >> 24) & 0xFF,
614 (chip_info[i] >> 16) & 0xFF,
615 (chip_info[i] >> 8) & 0xFF,
616 (chip_info[i] >> 0) & 0xFF);
617 }
618 printf("\n");
619 memcpy((char *)cbw, req->buf, USB_BULK_CB_WRAP_LEN);
620
621 /* Prepare for sending subsequent CSW_GOOD */
622 f_rkusb->tag = cbw->tag;
623 f_rkusb->in_req->complete = tx_handler_send_csw;
624
625 rockusb_tx_write((char *)chip_info, sizeof(chip_info));
626}
627
Alberto Panizzoe11f9162018-07-12 13:05:44 +0200628static void cb_read_lba(struct usb_ep *ep, struct usb_request *req)
629{
630 ALLOC_CACHE_ALIGN_BUFFER(struct fsg_bulk_cb_wrap, cbw,
631 sizeof(struct fsg_bulk_cb_wrap));
632 struct f_rockusb *f_rkusb = get_rkusb();
633 int sector_count;
634
635 memcpy((char *)cbw, req->buf, USB_BULK_CB_WRAP_LEN);
636 sector_count = (int)get_unaligned_be16(&cbw->CDB[7]);
637 f_rkusb->tag = cbw->tag;
638
639 if (!f_rkusb->desc) {
640 char *type = f_rkusb->dev_type;
641 int index = f_rkusb->dev_index;
642
643 f_rkusb->desc = blk_get_dev(type, index);
644 if (!f_rkusb->desc ||
645 f_rkusb->desc->type == DEV_TYPE_UNKNOWN) {
646 printf("invalid device \"%s\", %d\n", type, index);
647 rockusb_tx_write_csw(f_rkusb->tag, 0, CSW_FAIL,
648 USB_BULK_CS_WRAP_LEN);
649 return;
650 }
651 }
652
653 f_rkusb->lba = get_unaligned_be32(&cbw->CDB[2]);
654 f_rkusb->ul_size = sector_count * f_rkusb->desc->blksz;
655 f_rkusb->ul_bytes = 0;
656
657 debug("require read %x bytes, %x sectors from lba %x\n",
658 f_rkusb->ul_size, sector_count, f_rkusb->lba);
659
660 if (f_rkusb->ul_size == 0) {
661 rockusb_tx_write_csw(cbw->tag, cbw->data_transfer_length,
662 CSW_FAIL, USB_BULK_CS_WRAP_LEN);
663 return;
664 }
665
666 /* Start right now sending first chunk */
667 tx_handler_ul_image(ep, req);
668}
669
Eddie Caibf2b72b2017-12-15 08:17:10 +0800670static void cb_write_lba(struct usb_ep *ep, struct usb_request *req)
671{
672 ALLOC_CACHE_ALIGN_BUFFER(struct fsg_bulk_cb_wrap, cbw,
673 sizeof(struct fsg_bulk_cb_wrap));
674 struct f_rockusb *f_rkusb = get_rkusb();
675 int sector_count;
676
677 memcpy((char *)cbw, req->buf, USB_BULK_CB_WRAP_LEN);
678 sector_count = (int)get_unaligned_be16(&cbw->CDB[7]);
679 f_rkusb->lba = get_unaligned_be32(&cbw->CDB[2]);
680 f_rkusb->dl_size = sector_count * 512;
681 f_rkusb->dl_bytes = 0;
682 f_rkusb->tag = cbw->tag;
683 debug("require write %x bytes, %x sectors to lba %x\n",
684 f_rkusb->dl_size, sector_count, f_rkusb->lba);
685
686 if (f_rkusb->dl_size == 0) {
687 rockusb_tx_write_csw(cbw->tag, cbw->data_transfer_length,
688 CSW_FAIL, USB_BULK_CS_WRAP_LEN);
689 } else {
690 req->complete = rx_handler_dl_image;
691 req->length = rx_bytes_expected(ep);
692 }
693}
694
Alberto Panizzof68c8e82018-07-12 13:05:45 +0200695static void cb_erase_lba(struct usb_ep *ep, struct usb_request *req)
696{
697 ALLOC_CACHE_ALIGN_BUFFER(struct fsg_bulk_cb_wrap, cbw,
698 sizeof(struct fsg_bulk_cb_wrap));
699 struct f_rockusb *f_rkusb = get_rkusb();
700 int sector_count, lba, blks;
701
702 memcpy((char *)cbw, req->buf, USB_BULK_CB_WRAP_LEN);
703 sector_count = (int)get_unaligned_be16(&cbw->CDB[7]);
704 f_rkusb->tag = cbw->tag;
705
706 if (!f_rkusb->desc) {
707 char *type = f_rkusb->dev_type;
708 int index = f_rkusb->dev_index;
709
710 f_rkusb->desc = blk_get_dev(type, index);
711 if (!f_rkusb->desc ||
712 f_rkusb->desc->type == DEV_TYPE_UNKNOWN) {
713 printf("invalid device \"%s\", %d\n", type, index);
714 rockusb_tx_write_csw(f_rkusb->tag, 0, CSW_FAIL,
715 USB_BULK_CS_WRAP_LEN);
716 return;
717 }
718 }
719
720 lba = get_unaligned_be32(&cbw->CDB[2]);
721
722 debug("require erase %x sectors from lba %x\n",
723 sector_count, lba);
724
725 blks = blk_derase(f_rkusb->desc, lba, sector_count);
726 if (blks != sector_count) {
727 printf("failed erasing device %s: %d\n", f_rkusb->dev_type,
728 f_rkusb->dev_index);
729 rockusb_tx_write_csw(f_rkusb->tag,
730 cbw->data_transfer_length, CSW_FAIL,
731 USB_BULK_CS_WRAP_LEN);
732 return;
733 }
734
735 rockusb_tx_write_csw(cbw->tag, cbw->data_transfer_length, CSW_GOOD,
736 USB_BULK_CS_WRAP_LEN);
737}
738
Eddie Caibf2b72b2017-12-15 08:17:10 +0800739void __weak rkusb_set_reboot_flag(int flag)
740{
741 struct f_rockusb *f_rkusb = get_rkusb();
742
743 printf("rockkusb set reboot flag: %d\n", f_rkusb->reboot_flag);
744}
745
746static void compl_do_reset(struct usb_ep *ep, struct usb_request *req)
747{
748 struct f_rockusb *f_rkusb = get_rkusb();
749
750 rkusb_set_reboot_flag(f_rkusb->reboot_flag);
751 do_reset(NULL, 0, 0, NULL);
752}
753
754static void cb_reboot(struct usb_ep *ep, struct usb_request *req)
755{
756 ALLOC_CACHE_ALIGN_BUFFER(struct fsg_bulk_cb_wrap, cbw,
757 sizeof(struct fsg_bulk_cb_wrap));
758 struct f_rockusb *f_rkusb = get_rkusb();
759
Eddie Caibf2b72b2017-12-15 08:17:10 +0800760 memcpy((char *)cbw, req->buf, USB_BULK_CB_WRAP_LEN);
761 f_rkusb->reboot_flag = cbw->CDB[1];
762 rockusb_func->in_req->complete = compl_do_reset;
763 rockusb_tx_write_csw(cbw->tag, cbw->data_transfer_length, CSW_GOOD,
764 USB_BULK_CS_WRAP_LEN);
765}
766
767static void cb_not_support(struct usb_ep *ep, struct usb_request *req)
768{
769 ALLOC_CACHE_ALIGN_BUFFER(struct fsg_bulk_cb_wrap, cbw,
770 sizeof(struct fsg_bulk_cb_wrap));
771
772 memcpy((char *)cbw, req->buf, USB_BULK_CB_WRAP_LEN);
773 printf("Rockusb command %x not support yet\n", cbw->CDB[0]);
774 rockusb_tx_write_csw(cbw->tag, 0, CSW_FAIL, USB_BULK_CS_WRAP_LEN);
775}
776
777static const struct cmd_dispatch_info cmd_dispatch_info[] = {
778 {
779 .cmd = K_FW_TEST_UNIT_READY,
780 .cb = cb_test_unit_ready,
781 },
782 {
783 .cmd = K_FW_READ_FLASH_ID,
784 .cb = cb_read_storage_id,
785 },
786 {
787 .cmd = K_FW_SET_DEVICE_ID,
788 .cb = cb_not_support,
789 },
790 {
791 .cmd = K_FW_TEST_BAD_BLOCK,
792 .cb = cb_not_support,
793 },
794 {
795 .cmd = K_FW_READ_10,
796 .cb = cb_not_support,
797 },
798 {
799 .cmd = K_FW_WRITE_10,
800 .cb = cb_not_support,
801 },
802 {
803 .cmd = K_FW_ERASE_10,
804 .cb = cb_not_support,
805 },
806 {
807 .cmd = K_FW_WRITE_SPARE,
808 .cb = cb_not_support,
809 },
810 {
811 .cmd = K_FW_READ_SPARE,
812 .cb = cb_not_support,
813 },
814 {
815 .cmd = K_FW_ERASE_10_FORCE,
816 .cb = cb_not_support,
817 },
818 {
819 .cmd = K_FW_GET_VERSION,
820 .cb = cb_not_support,
821 },
822 {
823 .cmd = K_FW_LBA_READ_10,
Alberto Panizzoe11f9162018-07-12 13:05:44 +0200824 .cb = cb_read_lba,
Eddie Caibf2b72b2017-12-15 08:17:10 +0800825 },
826 {
827 .cmd = K_FW_LBA_WRITE_10,
828 .cb = cb_write_lba,
829 },
830 {
831 .cmd = K_FW_ERASE_SYS_DISK,
832 .cb = cb_not_support,
833 },
834 {
835 .cmd = K_FW_SDRAM_READ_10,
836 .cb = cb_not_support,
837 },
838 {
839 .cmd = K_FW_SDRAM_WRITE_10,
840 .cb = cb_not_support,
841 },
842 {
843 .cmd = K_FW_SDRAM_EXECUTE,
844 .cb = cb_not_support,
845 },
846 {
847 .cmd = K_FW_READ_FLASH_INFO,
848 .cb = cb_not_support,
849 },
850 {
851 .cmd = K_FW_GET_CHIP_VER,
Alberto Panizzoe4b34a72018-07-12 13:05:42 +0200852 .cb = cb_get_chip_version,
Eddie Caibf2b72b2017-12-15 08:17:10 +0800853 },
854 {
855 .cmd = K_FW_LOW_FORMAT,
856 .cb = cb_not_support,
857 },
858 {
859 .cmd = K_FW_SET_RESET_FLAG,
860 .cb = cb_not_support,
861 },
862 {
863 .cmd = K_FW_SPI_READ_10,
864 .cb = cb_not_support,
865 },
866 {
867 .cmd = K_FW_SPI_WRITE_10,
868 .cb = cb_not_support,
869 },
870 {
Alberto Panizzof68c8e82018-07-12 13:05:45 +0200871 .cmd = K_FW_LBA_ERASE_10,
872 .cb = cb_erase_lba,
873 },
874 {
Eddie Caibf2b72b2017-12-15 08:17:10 +0800875 .cmd = K_FW_SESSION,
876 .cb = cb_not_support,
877 },
878 {
879 .cmd = K_FW_RESET,
880 .cb = cb_reboot,
881 },
882};
883
884static void rx_handler_command(struct usb_ep *ep, struct usb_request *req)
885{
886 void (*func_cb)(struct usb_ep *ep, struct usb_request *req) = NULL;
887
888 ALLOC_CACHE_ALIGN_BUFFER(struct fsg_bulk_cb_wrap, cbw,
889 sizeof(struct fsg_bulk_cb_wrap));
890 char *cmdbuf = req->buf;
891 int i;
892
893 if (req->status || req->length == 0)
894 return;
895
896 memcpy((char *)cbw, req->buf, USB_BULK_CB_WRAP_LEN);
897#ifdef DEBUG
898 printcbw(req->buf);
899#endif
900
901 for (i = 0; i < ARRAY_SIZE(cmd_dispatch_info); i++) {
902 if (cmd_dispatch_info[i].cmd == cbw->CDB[0]) {
903 func_cb = cmd_dispatch_info[i].cb;
904 break;
905 }
906 }
907
908 if (!func_cb) {
909 printf("unknown command: %s\n", (char *)req->buf);
910 rockusb_tx_write_str("FAILunknown command");
911 } else {
912 if (req->actual < req->length) {
913 u8 *buf = (u8 *)req->buf;
914
915 buf[req->actual] = 0;
916 func_cb(ep, req);
917 } else {
918 puts("buffer overflow\n");
919 rockusb_tx_write_str("FAILbuffer overflow");
920 }
921 }
922
923 *cmdbuf = '\0';
924 req->actual = 0;
925 usb_ep_queue(ep, req, 0);
926}