183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
2453c95e0SEddie Cai /*
3453c95e0SEddie Cai * Copyright (C) 2017 Eddie Cai <eddie.cai.linux@gmail.com>
4453c95e0SEddie Cai */
5453c95e0SEddie Cai
6453c95e0SEddie Cai #include <common.h>
7453c95e0SEddie Cai #include <command.h>
8453c95e0SEddie Cai #include <console.h>
9453c95e0SEddie Cai #include <g_dnl.h>
10453c95e0SEddie Cai #include <usb.h>
11453c95e0SEddie Cai #include <asm/arch/f_rockusb.h>
12453c95e0SEddie Cai
do_rockusb(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])13453c95e0SEddie Cai static int do_rockusb(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
14453c95e0SEddie Cai {
15453c95e0SEddie Cai int controller_index, dev_index;
16453c95e0SEddie Cai char *usb_controller;
17453c95e0SEddie Cai char *devtype;
18453c95e0SEddie Cai char *devnum;
19453c95e0SEddie Cai int ret;
20453c95e0SEddie Cai
21453c95e0SEddie Cai if (argc < 2)
22453c95e0SEddie Cai return CMD_RET_USAGE;
23453c95e0SEddie Cai
24453c95e0SEddie Cai usb_controller = argv[1];
25453c95e0SEddie Cai controller_index = simple_strtoul(usb_controller, NULL, 0);
26453c95e0SEddie Cai
27453c95e0SEddie Cai if (argc >= 4) {
28453c95e0SEddie Cai devtype = argv[2];
29453c95e0SEddie Cai devnum = argv[3];
30453c95e0SEddie Cai } else {
31453c95e0SEddie Cai return CMD_RET_USAGE;
32453c95e0SEddie Cai }
33453c95e0SEddie Cai dev_index = simple_strtoul(devnum, NULL, 0);
34453c95e0SEddie Cai rockusb_dev_init(devtype, dev_index);
35453c95e0SEddie Cai
36*a06955aeSJean-Jacques Hiblot ret = usb_gadget_initialize(controller_index);
37453c95e0SEddie Cai if (ret) {
38453c95e0SEddie Cai printf("USB init failed: %d\n", ret);
39453c95e0SEddie Cai return CMD_RET_FAILURE;
40453c95e0SEddie Cai }
41453c95e0SEddie Cai
42453c95e0SEddie Cai g_dnl_clear_detach();
43453c95e0SEddie Cai ret = g_dnl_register("usb_dnl_rockusb");
44453c95e0SEddie Cai if (ret)
45453c95e0SEddie Cai return CMD_RET_FAILURE;
46453c95e0SEddie Cai
47453c95e0SEddie Cai if (!g_dnl_board_usb_cable_connected()) {
48453c95e0SEddie Cai puts("\rUSB cable not detected, Command exit.\n");
49453c95e0SEddie Cai ret = CMD_RET_FAILURE;
50453c95e0SEddie Cai goto exit;
51453c95e0SEddie Cai }
52453c95e0SEddie Cai
53453c95e0SEddie Cai while (1) {
54453c95e0SEddie Cai if (g_dnl_detach())
55453c95e0SEddie Cai break;
56453c95e0SEddie Cai if (ctrlc())
57453c95e0SEddie Cai break;
58453c95e0SEddie Cai usb_gadget_handle_interrupts(controller_index);
59453c95e0SEddie Cai }
60453c95e0SEddie Cai ret = CMD_RET_SUCCESS;
61453c95e0SEddie Cai
62453c95e0SEddie Cai exit:
63453c95e0SEddie Cai g_dnl_unregister();
64453c95e0SEddie Cai g_dnl_clear_detach();
65*a06955aeSJean-Jacques Hiblot usb_gadget_release(controller_index);
66453c95e0SEddie Cai
67453c95e0SEddie Cai return ret;
68453c95e0SEddie Cai }
69453c95e0SEddie Cai
70453c95e0SEddie Cai U_BOOT_CMD(rockusb, 4, 1, do_rockusb,
71453c95e0SEddie Cai "use the rockusb protocol",
72453c95e0SEddie Cai "<USB_controller> <devtype> <dev[:part]> e.g. rockusb 0 mmc 0\n"
73453c95e0SEddie Cai );
74