usb.c 19.9 KB
Newer Older
wdenk's avatar
wdenk committed
1 2 3 4
/*
 * (C) Copyright 2001
 * Denis Peter, MPL AG Switzerland
 *
5 6 7
 * Adapted for U-Boot driver model
 * (C) Copyright 2015 Google, Inc
 *
wdenk's avatar
wdenk committed
8 9 10
 * Most of this source has been derived from the Linux USB
 * project.
 *
11
 * SPDX-License-Identifier:	GPL-2.0+
wdenk's avatar
wdenk committed
12 13 14 15
 */

#include <common.h>
#include <command.h>
16
#include <console.h>
17
#include <dm.h>
18
#include <memalign.h>
wdenk's avatar
wdenk committed
19
#include <asm/byteorder.h>
20
#include <asm/unaligned.h>
21
#include <part.h>
wdenk's avatar
wdenk committed
22 23
#include <usb.h>

wdenk's avatar
wdenk committed
24
#ifdef CONFIG_USB_STORAGE
25
static int usb_stor_curr_dev = -1; /* current device */
wdenk's avatar
wdenk committed
26
#endif
27
#if defined(CONFIG_USB_HOST_ETHER) && !defined(CONFIG_DM_ETH)
28
static int __maybe_unused usb_ether_curr_dev = -1; /* current ethernet device */
29
#endif
wdenk's avatar
wdenk committed
30

wdenk's avatar
wdenk committed
31
/* some display routines (info command) */
Kim Phillips's avatar
Kim Phillips committed
32
static char *usb_get_class_desc(unsigned char dclass)
wdenk's avatar
wdenk committed
33
{
34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54
	switch (dclass) {
	case USB_CLASS_PER_INTERFACE:
		return "See Interface";
	case USB_CLASS_AUDIO:
		return "Audio";
	case USB_CLASS_COMM:
		return "Communication";
	case USB_CLASS_HID:
		return "Human Interface";
	case USB_CLASS_PRINTER:
		return "Printer";
	case USB_CLASS_MASS_STORAGE:
		return "Mass Storage";
	case USB_CLASS_HUB:
		return "Hub";
	case USB_CLASS_DATA:
		return "CDC Data";
	case USB_CLASS_VENDOR_SPEC:
		return "Vendor specific";
	default:
		return "";
wdenk's avatar
wdenk committed
55 56 57
	}
}

Kim Phillips's avatar
Kim Phillips committed
58 59
static void usb_display_class_sub(unsigned char dclass, unsigned char subclass,
				  unsigned char proto)
wdenk's avatar
wdenk committed
60
{
61 62 63 64 65 66 67 68 69
	switch (dclass) {
	case USB_CLASS_PER_INTERFACE:
		printf("See Interface");
		break;
	case USB_CLASS_HID:
		printf("Human Interface, Subclass: ");
		switch (subclass) {
		case USB_SUB_HID_NONE:
			printf("None");
wdenk's avatar
wdenk committed
70
			break;
71 72 73 74 75 76 77 78 79 80 81 82 83 84 85
		case USB_SUB_HID_BOOT:
			printf("Boot ");
			switch (proto) {
			case USB_PROT_HID_NONE:
				printf("None");
				break;
			case USB_PROT_HID_KEYBOARD:
				printf("Keyboard");
				break;
			case USB_PROT_HID_MOUSE:
				printf("Mouse");
				break;
			default:
				printf("reserved");
				break;
wdenk's avatar
wdenk committed
86 87
			}
			break;
88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127
		default:
			printf("reserved");
			break;
		}
		break;
	case USB_CLASS_MASS_STORAGE:
		printf("Mass Storage, ");
		switch (subclass) {
		case US_SC_RBC:
			printf("RBC ");
			break;
		case US_SC_8020:
			printf("SFF-8020i (ATAPI)");
			break;
		case US_SC_QIC:
			printf("QIC-157 (Tape)");
			break;
		case US_SC_UFI:
			printf("UFI");
			break;
		case US_SC_8070:
			printf("SFF-8070");
			break;
		case US_SC_SCSI:
			printf("Transp. SCSI");
			break;
		default:
			printf("reserved");
			break;
		}
		printf(", ");
		switch (proto) {
		case US_PR_CB:
			printf("Command/Bulk");
			break;
		case US_PR_CBI:
			printf("Command/Bulk/Int");
			break;
		case US_PR_BULK:
			printf("Bulk only");
wdenk's avatar
wdenk committed
128 129
			break;
		default:
130 131 132 133 134 135 136
			printf("reserved");
			break;
		}
		break;
	default:
		printf("%s", usb_get_class_desc(dclass));
		break;
wdenk's avatar
wdenk committed
137 138 139
	}
}

Kim Phillips's avatar
Kim Phillips committed
140
static void usb_display_string(struct usb_device *dev, int index)
wdenk's avatar
wdenk committed
141
{
142 143
	ALLOC_CACHE_ALIGN_BUFFER(char, buffer, 256);

144 145 146
	if (index != 0) {
		if (usb_string(dev, index, &buffer[0], 256) > 0)
			printf("String: \"%s\"", buffer);
wdenk's avatar
wdenk committed
147 148 149
	}
}

Kim Phillips's avatar
Kim Phillips committed
150
static void usb_display_desc(struct usb_device *dev)
wdenk's avatar
wdenk committed
151
{
152 153
	if (dev->descriptor.bDescriptorType == USB_DT_DEVICE) {
		printf("%d: %s,  USB Revision %x.%x\n", dev->devnum,
154
		usb_get_class_desc(dev->config.if_desc[0].desc.bInterfaceClass),
155 156 157 158 159 160 161
				   (dev->descriptor.bcdUSB>>8) & 0xff,
				   dev->descriptor.bcdUSB & 0xff);

		if (strlen(dev->mf) || strlen(dev->prod) ||
		    strlen(dev->serial))
			printf(" - %s %s %s\n", dev->mf, dev->prod,
				dev->serial);
wdenk's avatar
wdenk committed
162 163
		if (dev->descriptor.bDeviceClass) {
			printf(" - Class: ");
164 165 166
			usb_display_class_sub(dev->descriptor.bDeviceClass,
					      dev->descriptor.bDeviceSubClass,
					      dev->descriptor.bDeviceProtocol);
wdenk's avatar
wdenk committed
167
			printf("\n");
168 169 170
		} else {
			printf(" - Class: (from Interface) %s\n",
			       usb_get_class_desc(
171
				dev->config.if_desc[0].desc.bInterfaceClass));
wdenk's avatar
wdenk committed
172
		}
173 174 175 176 177 178 179
		printf(" - PacketSize: %d  Configurations: %d\n",
			dev->descriptor.bMaxPacketSize0,
			dev->descriptor.bNumConfigurations);
		printf(" - Vendor: 0x%04x  Product 0x%04x Version %d.%d\n",
			dev->descriptor.idVendor, dev->descriptor.idProduct,
			(dev->descriptor.bcdDevice>>8) & 0xff,
			dev->descriptor.bcdDevice & 0xff);
wdenk's avatar
wdenk committed
180 181 182 183
	}

}

184
static void usb_display_conf_desc(struct usb_config_descriptor *config,
Kim Phillips's avatar
Kim Phillips committed
185
				  struct usb_device *dev)
wdenk's avatar
wdenk committed
186
{
187 188 189 190
	printf("   Configuration: %d\n", config->bConfigurationValue);
	printf("   - Interfaces: %d %s%s%dmA\n", config->bNumInterfaces,
	       (config->bmAttributes & 0x40) ? "Self Powered " : "Bus Powered ",
	       (config->bmAttributes & 0x20) ? "Remote Wakeup " : "",
191
		config->bMaxPower*2);
wdenk's avatar
wdenk committed
192 193
	if (config->iConfiguration) {
		printf("   - ");
194
		usb_display_string(dev, config->iConfiguration);
wdenk's avatar
wdenk committed
195 196 197 198
		printf("\n");
	}
}

Kim Phillips's avatar
Kim Phillips committed
199 200
static void usb_display_if_desc(struct usb_interface_descriptor *ifdesc,
				struct usb_device *dev)
wdenk's avatar
wdenk committed
201
{
202 203 204
	printf("     Interface: %d\n", ifdesc->bInterfaceNumber);
	printf("     - Alternate Setting %d, Endpoints: %d\n",
		ifdesc->bAlternateSetting, ifdesc->bNumEndpoints);
wdenk's avatar
wdenk committed
205
	printf("     - Class ");
206 207
	usb_display_class_sub(ifdesc->bInterfaceClass,
		ifdesc->bInterfaceSubClass, ifdesc->bInterfaceProtocol);
wdenk's avatar
wdenk committed
208 209 210
	printf("\n");
	if (ifdesc->iInterface) {
		printf("     - ");
211
		usb_display_string(dev, ifdesc->iInterface);
wdenk's avatar
wdenk committed
212 213 214 215
		printf("\n");
	}
}

Kim Phillips's avatar
Kim Phillips committed
216
static void usb_display_ep_desc(struct usb_endpoint_descriptor *epdesc)
wdenk's avatar
wdenk committed
217
{
218 219 220 221 222 223 224 225 226 227 228 229 230 231 232
	printf("     - Endpoint %d %s ", epdesc->bEndpointAddress & 0xf,
		(epdesc->bEndpointAddress & 0x80) ? "In" : "Out");
	switch ((epdesc->bmAttributes & 0x03)) {
	case 0:
		printf("Control");
		break;
	case 1:
		printf("Isochronous");
		break;
	case 2:
		printf("Bulk");
		break;
	case 3:
		printf("Interrupt");
		break;
wdenk's avatar
wdenk committed
233
	}
234
	printf(" MaxPacket %d", get_unaligned(&epdesc->wMaxPacketSize));
235 236
	if ((epdesc->bmAttributes & 0x03) == 0x3)
		printf(" Interval %dms", epdesc->bInterval);
wdenk's avatar
wdenk committed
237 238 239 240
	printf("\n");
}

/* main routine to diasplay the configs, interfaces and endpoints */
Kim Phillips's avatar
Kim Phillips committed
241
static void usb_display_config(struct usb_device *dev)
wdenk's avatar
wdenk committed
242
{
243 244
	struct usb_config *config;
	struct usb_interface *ifdesc;
wdenk's avatar
wdenk committed
245
	struct usb_endpoint_descriptor *epdesc;
246 247 248
	int i, ii;

	config = &dev->config;
249
	usb_display_conf_desc(&config->desc, dev);
250 251
	for (i = 0; i < config->no_of_if; i++) {
		ifdesc = &config->if_desc[i];
252
		usb_display_if_desc(&ifdesc->desc, dev);
253 254
		for (ii = 0; ii < ifdesc->no_of_ep; ii++) {
			epdesc = &ifdesc->ep_desc[ii];
wdenk's avatar
wdenk committed
255 256 257 258 259 260
			usb_display_ep_desc(epdesc);
		}
	}
	printf("\n");
}

261 262 263 264 265
/*
 * With driver model this isn't right since we can have multiple controllers
 * and the device numbering starts at 1 on each bus.
 * TODO(sjg@chromium.org): Add a way to specify the controller/bus.
 */
266 267
static struct usb_device *usb_find_device(int devnum)
{
268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284
#ifdef CONFIG_DM_USB
	struct usb_device *udev;
	struct udevice *hub;
	struct uclass *uc;
	int ret;

	/* Device addresses start at 1 */
	devnum++;
	ret = uclass_get(UCLASS_USB_HUB, &uc);
	if (ret)
		return NULL;

	uclass_foreach_dev(hub, uc) {
		struct udevice *dev;

		if (!device_active(hub))
			continue;
285
		udev = dev_get_parent_priv(hub);
286 287 288 289 290 291 292 293 294
		if (udev->devnum == devnum)
			return udev;

		for (device_find_first_child(hub, &dev);
		     dev;
		     device_find_next_child(&dev)) {
			if (!device_active(hub))
				continue;

295
			udev = dev_get_parent_priv(dev);
296 297 298 299 300
			if (udev->devnum == devnum)
				return udev;
		}
	}
#else
301
	struct usb_device *udev;
302 303 304
	int d;

	for (d = 0; d < USB_MAX_DEVICE; d++) {
305 306
		udev = usb_get_dev_index(d);
		if (udev == NULL)
307
			return NULL;
308 309
		if (udev->devnum == devnum)
			return udev;
310
	}
311
#endif
312 313 314 315

	return NULL;
}

316 317
static inline char *portspeed(int speed)
{
318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335
	char *speed_str;

	switch (speed) {
	case USB_SPEED_SUPER:
		speed_str = "5 Gb/s";
		break;
	case USB_SPEED_HIGH:
		speed_str = "480 Mb/s";
		break;
	case USB_SPEED_LOW:
		speed_str = "1.5 Mb/s";
		break;
	default:
		speed_str = "12 Mb/s";
		break;
	}

	return speed_str;
336 337
}

wdenk's avatar
wdenk committed
338
/* shows the device tree recursively */
Kim Phillips's avatar
Kim Phillips committed
339
static void usb_show_tree_graph(struct usb_device *dev, char *pre)
wdenk's avatar
wdenk committed
340
{
341
	int index;
342
	int has_child, last_child;
wdenk's avatar
wdenk committed
343

344 345
	index = strlen(pre);
	printf(" %s", pre);
346 347 348
#ifdef CONFIG_DM_USB
	has_child = device_has_active_children(dev->dev);
#else
wdenk's avatar
wdenk committed
349
	/* check if the device has connected children */
350 351
	int i;

352 353 354 355
	has_child = 0;
	for (i = 0; i < dev->maxchild; i++) {
		if (dev->children[i] != NULL)
			has_child = 1;
wdenk's avatar
wdenk committed
356
	}
357
#endif
wdenk's avatar
wdenk committed
358
	/* check if we are the last one */
359
#ifdef CONFIG_DM_USB
Hans de Goede's avatar
Hans de Goede committed
360 361 362
	/* Not the root of the usb tree? */
	if (device_get_uclass_id(dev->dev->parent) != UCLASS_USB) {
		last_child = device_is_last_sibling(dev->dev);
363
#else
Hans de Goede's avatar
Hans de Goede committed
364 365
	if (dev->parent != NULL) { /* not root? */
		last_child = 1;
366
		for (i = 0; i < dev->parent->maxchild; i++) {
wdenk's avatar
wdenk committed
367
			/* search for children */
368 369 370 371 372 373
			if (dev->parent->children[i] == dev) {
				/* found our pointer, see if we have a
				 * little sister
				 */
				while (i++ < dev->parent->maxchild) {
					if (dev->parent->children[i] != NULL) {
wdenk's avatar
wdenk committed
374
						/* found a sister */
375
						last_child = 0;
wdenk's avatar
wdenk committed
376 377 378 379 380
						break;
					} /* if */
				} /* while */
			} /* device found */
		} /* for all children of the parent */
381
#endif
wdenk's avatar
wdenk committed
382 383
		printf("\b+-");
		/* correct last child */
384
		if (last_child && index)
385
			pre[index-1] = ' ';
wdenk's avatar
wdenk committed
386 387 388
	} /* if not root hub */
	else
		printf(" ");
389 390 391 392 393
	printf("%d ", dev->devnum);
	pre[index++] = ' ';
	pre[index++] = has_child ? '|' : ' ';
	pre[index] = 0;
	printf(" %s (%s, %dmA)\n", usb_get_class_desc(
394
					dev->config.if_desc[0].desc.bInterfaceClass),
395
					portspeed(dev->speed),
396
					dev->config.desc.bMaxPower * 2);
397 398 399
	if (strlen(dev->mf) || strlen(dev->prod) || strlen(dev->serial))
		printf(" %s  %s %s %s\n", pre, dev->mf, dev->prod, dev->serial);
	printf(" %s\n", pre);
400 401 402 403 404 405 406 407 408 409 410
#ifdef CONFIG_DM_USB
	struct udevice *child;

	for (device_find_first_child(dev->dev, &child);
	     child;
	     device_find_next_child(&child)) {
		struct usb_device *udev;

		if (!device_active(child))
			continue;

411
		udev = dev_get_parent_priv(child);
412 413 414 415 416 417 418 419

		/* Ignore emulators, we only want real devices */
		if (device_get_uclass_id(child) != UCLASS_USB_EMUL) {
			usb_show_tree_graph(udev, pre);
			pre[index] = 0;
		}
	}
#else
420 421 422 423 424
	if (dev->maxchild > 0) {
		for (i = 0; i < dev->maxchild; i++) {
			if (dev->children[i] != NULL) {
				usb_show_tree_graph(dev->children[i], pre);
				pre[index] = 0;
wdenk's avatar
wdenk committed
425 426 427
			}
		}
	}
428
#endif
wdenk's avatar
wdenk committed
429 430 431
}

/* main routine for the tree command */
432
static void usb_show_subtree(struct usb_device *dev)
wdenk's avatar
wdenk committed
433 434 435
{
	char preamble[32];

436
	memset(preamble, '\0', sizeof(preamble));
437
	usb_show_tree_graph(dev, &preamble[0]);
wdenk's avatar
wdenk committed
438 439
}

440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470
void usb_show_tree(void)
{
#ifdef CONFIG_DM_USB
	struct udevice *bus;

	for (uclass_first_device(UCLASS_USB, &bus);
		bus;
		uclass_next_device(&bus)) {
		struct usb_device *udev;
		struct udevice *dev;

		device_find_first_child(bus, &dev);
		if (dev && device_active(dev)) {
			udev = dev_get_parent_priv(dev);
			usb_show_subtree(udev);
		}
	}
#else
	struct usb_device *udev;
	int i;

	for (i = 0; i < USB_MAX_DEVICE; i++) {
		udev = usb_get_dev_index(i);
		if (udev == NULL)
			break;
		if (udev->parent == NULL)
			usb_show_subtree(udev);
	}
#endif
}

471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530
static int usb_test(struct usb_device *dev, int port, char* arg)
{
	int mode;

	if (port > dev->maxchild) {
		printf("Device is no hub or does not have %d ports.\n", port);
		return 1;
	}

	switch (arg[0]) {
	case 'J':
	case 'j':
		printf("Setting Test_J mode");
		mode = USB_TEST_MODE_J;
		break;
	case 'K':
	case 'k':
		printf("Setting Test_K mode");
		mode = USB_TEST_MODE_K;
		break;
	case 'S':
	case 's':
		printf("Setting Test_SE0_NAK mode");
		mode = USB_TEST_MODE_SE0_NAK;
		break;
	case 'P':
	case 'p':
		printf("Setting Test_Packet mode");
		mode = USB_TEST_MODE_PACKET;
		break;
	case 'F':
	case 'f':
		printf("Setting Test_Force_Enable mode");
		mode = USB_TEST_MODE_FORCE_ENABLE;
		break;
	default:
		printf("Unrecognized test mode: %s\nAvailable modes: "
		       "J, K, S[E0_NAK], P[acket], F[orce_Enable]\n", arg);
		return 1;
	}

	if (port)
		printf(" on downstream facing port %d...\n", port);
	else
		printf(" on upstream facing port...\n");

	if (usb_control_msg(dev, usb_sndctrlpipe(dev, 0), USB_REQ_SET_FEATURE,
			    port ? USB_RT_PORT : USB_RECIP_DEVICE,
			    port ? USB_PORT_FEAT_TEST : USB_FEAT_TEST,
			    (mode << 8) | port,
			    NULL, 0, USB_CNTL_TIMEOUT) == -1) {
		printf("Error during SET_FEATURE.\n");
		return 1;
	} else {
		printf("Test mode successfully set. Use 'usb start' "
		       "to return to normal operation.\n");
		return 0;
	}
}

wdenk's avatar
wdenk committed
531 532 533 534 535

/******************************************************************************
 * usb boot command intepreter. Derived from diskboot
 */
#ifdef CONFIG_USB_STORAGE
Kim Phillips's avatar
Kim Phillips committed
536
static int do_usbboot(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
wdenk's avatar
wdenk committed
537
{
538
	return common_diskboot(cmdtp, "usb", argc, argv);
wdenk's avatar
wdenk committed
539 540 541
}
#endif /* CONFIG_USB_STORAGE */

542
static int do_usb_stop_keyboard(int force)
543 544
{
#ifdef CONFIG_USB_KEYBOARD
545
	if (usb_kbd_deregister(force) != 0) {
546 547 548 549 550 551
		printf("USB not stopped: usbkbd still using USB\n");
		return 1;
	}
#endif
	return 0;
}
wdenk's avatar
wdenk committed
552

553 554 555 556 557 558 559
static void do_usb_start(void)
{
	bootstage_mark_name(BOOTSTAGE_ID_USB_START, "usb_start");

	if (usb_init() < 0)
		return;

560 561
	/* Driver model will probe the devices as they are found */
#ifndef CONFIG_DM_USB
562
# ifdef CONFIG_USB_STORAGE
563 564
	/* try to recognize storage devices immediately */
	usb_stor_curr_dev = usb_stor_scan(1);
565 566 567 568 569
# endif
# ifdef CONFIG_USB_KEYBOARD
	drv_usb_kbd_init();
# endif
#endif /* !CONFIG_DM_USB */
570
#ifdef CONFIG_USB_HOST_ETHER
571
# ifdef CONFIG_DM_ETH
572 573 574 575
#  ifndef CONFIG_DM_USB
#   error "You must use CONFIG_DM_USB if you want to use CONFIG_USB_HOST_ETHER with CONFIG_DM_ETH"
#  endif
# else
576 577
	/* try to recognize ethernet devices immediately */
	usb_ether_curr_dev = usb_host_eth_scan(1);
578
# endif
579
#endif
580 581
}

582 583 584 585 586 587
#ifdef CONFIG_DM_USB
static void show_info(struct udevice *dev)
{
	struct udevice *child;
	struct usb_device *udev;

588
	udev = dev_get_parent_priv(dev);
589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618
	usb_display_desc(udev);
	usb_display_config(udev);
	for (device_find_first_child(dev, &child);
	     child;
	     device_find_next_child(&child)) {
		if (device_active(child))
			show_info(child);
	}
}

static int usb_device_info(void)
{
	struct udevice *bus;

	for (uclass_first_device(UCLASS_USB, &bus);
	     bus;
	     uclass_next_device(&bus)) {
		struct udevice *hub;

		device_find_first_child(bus, &hub);
		if (device_get_uclass_id(hub) == UCLASS_USB_HUB &&
		    device_active(hub)) {
			show_info(hub);
		}
	}

	return 0;
}
#endif

619
/******************************************************************************
wdenk's avatar
wdenk committed
620 621
 * usb command intepreter
 */
Kim Phillips's avatar
Kim Phillips committed
622
static int do_usb(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
wdenk's avatar
wdenk committed
623
{
624
	struct usb_device *udev = NULL;
wdenk's avatar
wdenk committed
625
	int i;
626
	extern char usb_started;
wdenk's avatar
wdenk committed
627
#ifdef CONFIG_USB_STORAGE
628
	struct blk_desc *stor_dev;
wdenk's avatar
wdenk committed
629
#endif
wdenk's avatar
wdenk committed
630

631
	if (argc < 2)
632
		return CMD_RET_USAGE;
633

634 635 636 637 638 639 640 641 642 643
	if (strncmp(argv[1], "start", 5) == 0) {
		if (usb_started)
			return 0; /* Already started */
		printf("starting USB...\n");
		do_usb_start();
		return 0;
	}

	if (strncmp(argv[1], "reset", 5) == 0) {
		printf("resetting USB...\n");
644
		if (do_usb_stop_keyboard(1) != 0)
645
			return 1;
wdenk's avatar
wdenk committed
646
		usb_stop();
647
		do_usb_start();
wdenk's avatar
wdenk committed
648 649
		return 0;
	}
650
	if (strncmp(argv[1], "stop", 4) == 0) {
651
		if (argc != 2)
652
			console_assign(stdin, "serial");
653
		if (do_usb_stop_keyboard(0) != 0)
654
			return 1;
wdenk's avatar
wdenk committed
655 656 657 658
		printf("stopping USB..\n");
		usb_stop();
		return 0;
	}
659 660 661 662
	if (!usb_started) {
		printf("USB is stopped. Please issue 'usb start' first.\n");
		return 1;
	}
663
	if (strncmp(argv[1], "tree", 4) == 0) {
664
		puts("USB device tree:\n");
665
		usb_show_tree();
wdenk's avatar
wdenk committed
666 667
		return 0;
	}
668 669
	if (strncmp(argv[1], "inf", 3) == 0) {
		if (argc == 2) {
670 671 672 673
#ifdef CONFIG_DM_USB
			usb_device_info();
#else
			int d;
674
			for (d = 0; d < USB_MAX_DEVICE; d++) {
675 676
				udev = usb_get_dev_index(d);
				if (udev == NULL)
wdenk's avatar
wdenk committed
677
					break;
678 679
				usb_display_desc(udev);
				usb_display_config(udev);
wdenk's avatar
wdenk committed
680
			}
681
#endif
wdenk's avatar
wdenk committed
682
			return 0;
683
		} else {
684 685 686 687 688
			/*
			 * With driver model this isn't right since we can
			 * have multiple controllers and the device numbering
			 * starts at 1 on each bus.
			 */
689
			i = simple_strtoul(argv[2], NULL, 10);
690
			printf("config for device %d\n", i);
691 692
			udev = usb_find_device(i);
			if (udev == NULL) {
693
				printf("*** No device available ***\n");
wdenk's avatar
wdenk committed
694
				return 0;
695
			} else {
696 697
				usb_display_desc(udev);
				usb_display_config(udev);
wdenk's avatar
wdenk committed
698 699 700 701
			}
		}
		return 0;
	}
702 703 704 705
	if (strncmp(argv[1], "test", 4) == 0) {
		if (argc < 5)
			return CMD_RET_USAGE;
		i = simple_strtoul(argv[2], NULL, 10);
706 707
		udev = usb_find_device(i);
		if (udev == NULL) {
708 709 710 711
			printf("Device %d does not exist.\n", i);
			return 1;
		}
		i = simple_strtoul(argv[3], NULL, 10);
712
		return usb_test(udev, i, argv[4]);
713
	}
wdenk's avatar
wdenk committed
714
#ifdef CONFIG_USB_STORAGE
715
	if (strncmp(argv[1], "stor", 4) == 0)
716
		return usb_stor_info();
717

718
	if (strncmp(argv[1], "part", 4) == 0) {
Christian Eggers's avatar
Christian Eggers committed
719
		int devno, ok = 0;
720
		if (argc == 2) {
Kim B. Heino's avatar
Kim B. Heino committed
721
			for (devno = 0; ; ++devno) {
722
				stor_dev = usb_stor_get_dev(devno);
Kim B. Heino's avatar
Kim B. Heino committed
723 724
				if (stor_dev == NULL)
					break;
725
				if (stor_dev->type != DEV_TYPE_UNKNOWN) {
Christian Eggers's avatar
Christian Eggers committed
726 727 728
					ok++;
					if (devno)
						printf("\n");
729
					debug("print_part of %x\n", devno);
Christian Eggers's avatar
Christian Eggers committed
730 731 732
					print_part(stor_dev);
				}
			}
733 734 735
		} else {
			devno = simple_strtoul(argv[2], NULL, 16);
			stor_dev = usb_stor_get_dev(devno);
Kim B. Heino's avatar
Kim B. Heino committed
736 737
			if (stor_dev != NULL &&
			    stor_dev->type != DEV_TYPE_UNKNOWN) {
wdenk's avatar
wdenk committed
738
				ok++;
739
				debug("print_part of %x\n", devno);
wdenk's avatar
wdenk committed
740 741 742 743 744 745 746 747 748
				print_part(stor_dev);
			}
		}
		if (!ok) {
			printf("\nno USB devices available\n");
			return 1;
		}
		return 0;
	}
749 750
	if (strcmp(argv[1], "read") == 0) {
		if (usb_stor_curr_dev < 0) {
wdenk's avatar
wdenk committed
751 752 753
			printf("no current device selected\n");
			return 1;
		}
754
		if (argc == 5) {
wdenk's avatar
wdenk committed
755 756 757 758
			unsigned long addr = simple_strtoul(argv[2], NULL, 16);
			unsigned long blk  = simple_strtoul(argv[3], NULL, 16);
			unsigned long cnt  = simple_strtoul(argv[4], NULL, 16);
			unsigned long n;
759 760 761
			printf("\nUSB read: device %d block # %ld, count %ld"
				" ... ", usb_stor_curr_dev, blk, cnt);
			stor_dev = usb_stor_get_dev(usb_stor_curr_dev);
762
			n = stor_dev->block_read(stor_dev, blk, cnt,
763 764 765 766
						 (ulong *)addr);
			printf("%ld blocks read: %s\n", n,
				(n == cnt) ? "OK" : "ERROR");
			if (n == cnt)
wdenk's avatar
wdenk committed
767 768 769 770
				return 0;
			return 1;
		}
	}
771 772 773 774 775 776 777 778 779 780 781 782 783
	if (strcmp(argv[1], "write") == 0) {
		if (usb_stor_curr_dev < 0) {
			printf("no current device selected\n");
			return 1;
		}
		if (argc == 5) {
			unsigned long addr = simple_strtoul(argv[2], NULL, 16);
			unsigned long blk  = simple_strtoul(argv[3], NULL, 16);
			unsigned long cnt  = simple_strtoul(argv[4], NULL, 16);
			unsigned long n;
			printf("\nUSB write: device %d block # %ld, count %ld"
				" ... ", usb_stor_curr_dev, blk, cnt);
			stor_dev = usb_stor_get_dev(usb_stor_curr_dev);
784
			n = stor_dev->block_write(stor_dev, blk, cnt,
785 786 787 788 789 790 791 792
						(ulong *)addr);
			printf("%ld blocks write: %s\n", n,
				(n == cnt) ? "OK" : "ERROR");
			if (n == cnt)
				return 0;
			return 1;
		}
	}
793 794
	if (strncmp(argv[1], "dev", 3) == 0) {
		if (argc == 3) {
wdenk's avatar
wdenk committed
795
			int dev = (int)simple_strtoul(argv[2], NULL, 10);
796
			printf("\nUSB device %d: ", dev);
Kim B. Heino's avatar
Kim B. Heino committed
797 798
			stor_dev = usb_stor_get_dev(dev);
			if (stor_dev == NULL) {
wdenk's avatar
wdenk committed
799 800 801
				printf("unknown device\n");
				return 1;
			}
802
			printf("\n    Device %d: ", dev);
wdenk's avatar
wdenk committed
803
			dev_print(stor_dev);
804
			if (stor_dev->type == DEV_TYPE_UNKNOWN)
wdenk's avatar
wdenk committed
805 806 807 808
				return 1;
			usb_stor_curr_dev = dev;
			printf("... is now current device\n");
			return 0;
809 810 811
		} else {
			printf("\nUSB device %d: ", usb_stor_curr_dev);
			stor_dev = usb_stor_get_dev(usb_stor_curr_dev);
wdenk's avatar
wdenk committed
812
			dev_print(stor_dev);
813
			if (stor_dev->type == DEV_TYPE_UNKNOWN)
wdenk's avatar
wdenk committed
814 815 816 817 818 819
				return 1;
			return 0;
		}
		return 0;
	}
#endif /* CONFIG_USB_STORAGE */
820
	return CMD_RET_USAGE;
wdenk's avatar
wdenk committed
821 822
}

823 824
U_BOOT_CMD(
	usb,	5,	1,	do_usb,
Peter Tyser's avatar
Peter Tyser committed
825
	"USB sub-system",
826 827
	"start - start (scan) USB controller\n"
	"usb reset - reset (rescan) USB controller\n"
828 829
	"usb stop [f] - stop USB [f]=force stop\n"
	"usb tree - show USB device tree\n"
830
	"usb info [dev] - show available USB devices\n"
831 832 833 834
	"usb test [dev] [port] [mode] - set USB 2.0 test mode\n"
	"    (specify port 0 to indicate the device's upstream port)\n"
	"    Available modes: J, K, S[E0_NAK], P[acket], F[orce_Enable]\n"
#ifdef CONFIG_USB_STORAGE
835
	"usb storage - show details of USB storage devices\n"
836
	"usb dev [dev] - show or set current USB storage device\n"
837
	"usb part [dev] - print partition table of one or all USB storage"
838
	"    devices\n"
839
	"usb read addr blk# cnt - read `cnt' blocks starting at block `blk#'\n"
840
	"    to memory address `addr'\n"
841 842
	"usb write addr blk# cnt - write `cnt' blocks starting at block `blk#'\n"
	"    from memory address `addr'"
843
#endif /* CONFIG_USB_STORAGE */
wdenk's avatar
wdenk committed
844 845 846
);


847
#ifdef CONFIG_USB_STORAGE
848 849
U_BOOT_CMD(
	usbboot,	3,	1,	do_usbboot,
Peter Tyser's avatar
Peter Tyser committed
850
	"boot from USB device",
Wolfgang Denk's avatar
Wolfgang Denk committed
851
	"loadAddr dev:part"
wdenk's avatar
wdenk committed
852
);
853
#endif /* CONFIG_USB_STORAGE */