int do_usb_mass_storage(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) { char *ep; unsigned int dev_num = 0, offset = 0, part_size = 0; int rc; struct ums_board_info *ums_info; static char *s = "ums"; if (argc < 2) { printf("usage: ums <dev> - e.g. ums 0\n"); return 0; } dev_num = (int)simple_strtoul(argv[1], &ep, 16); if (dev_num) { puts("\nSet eMMC device to 0! - e.g. ums 0\n"); goto fail; } board_usb_init(); ums_info = board_ums_init(dev_num, offset, part_size); if (!ums_info) { printf("MMC: %d -> NOT available\n", dev_num); goto fail; } rc = fsg_init(ums_info); if (rc) { printf("cmd ums: fsg_init failed\n"); goto fail; } g_dnl_register(s); while (1) { /* Handle control-c and timeouts */ if (ctrlc()) { printf("The remote end did not respond in time.\n"); goto exit; } usb_gadget_handle_interrupts(); /* Check if USB cable has been detached */ if (fsg_main_thread(NULL) == EIO) goto exit; } exit: g_dnl_unregister(); return 0; fail: return -1; }
static int do_usb_mass_storage(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) { const char *usb_controller; const char *devtype; const char *devnum; unsigned int controller_index; int rc; int cable_ready_timeout __maybe_unused; if (argc < 3) return CMD_RET_USAGE; usb_controller = argv[1]; if (argc >= 4) { devtype = argv[2]; devnum = argv[3]; } else { devtype = "mmc"; devnum = argv[2]; } rc = ums_init(devtype, devnum); if (rc < 0) return CMD_RET_FAILURE; controller_index = (unsigned int)(simple_strtoul( usb_controller, NULL, 0)); if (board_usb_init(controller_index, USB_INIT_DEVICE)) { pr_err("Couldn't init USB controller.\n"); rc = CMD_RET_FAILURE; goto cleanup_ums_init; } rc = fsg_init(ums, ums_count); if (rc) { pr_err("fsg_init failed\n"); rc = CMD_RET_FAILURE; goto cleanup_board; } rc = g_dnl_register("usb_dnl_ums"); if (rc) { pr_err("g_dnl_register failed\n"); rc = CMD_RET_FAILURE; goto cleanup_board; } /* Timeout unit: seconds */ cable_ready_timeout = UMS_CABLE_READY_TIMEOUT; if (!g_dnl_board_usb_cable_connected()) { /* * Won't execute if we don't know whether the cable is * connected. */ puts("Please connect USB cable.\n"); while (!g_dnl_board_usb_cable_connected()) { if (ctrlc()) { puts("\rCTRL+C - Operation aborted.\n"); rc = CMD_RET_SUCCESS; goto cleanup_register; } if (!cable_ready_timeout) { puts("\rUSB cable not detected.\n" \ "Command exit.\n"); rc = CMD_RET_SUCCESS; goto cleanup_register; } printf("\rAuto exit in: %.2d s.", cable_ready_timeout); mdelay(1000); cable_ready_timeout--; } puts("\r\n"); } while (1) { usb_gadget_handle_interrupts(controller_index); rc = fsg_main_thread(NULL); if (rc) { /* Check I/O error */ if (rc == -EIO) printf("\rCheck USB cable connection\n"); /* Check CTRL+C */ if (rc == -EPIPE) printf("\rCTRL+C - Operation aborted\n"); rc = CMD_RET_SUCCESS; goto cleanup_register; } } cleanup_register: g_dnl_unregister(); cleanup_board: board_usb_cleanup(controller_index, USB_INIT_DEVICE); cleanup_ums_init: ums_fini(); return rc; }