172 lines
		
	
	
		
			4.0 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			172 lines
		
	
	
		
			4.0 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * (C) Copyright 2000-2011
 | |
|  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 | |
|  *
 | |
|  * SPDX-License-Identifier:	GPL-2.0+
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * IDE support
 | |
|  */
 | |
| 
 | |
| #include <common.h>
 | |
| #include <blk.h>
 | |
| #include <config.h>
 | |
| #include <watchdog.h>
 | |
| #include <command.h>
 | |
| #include <image.h>
 | |
| #include <asm/byteorder.h>
 | |
| #include <asm/io.h>
 | |
| 
 | |
| #if defined(CONFIG_IDE_8xx_DIRECT) || defined(CONFIG_IDE_PCMCIA)
 | |
| # include <pcmcia.h>
 | |
| #endif
 | |
| 
 | |
| #include <ide.h>
 | |
| #include <ata.h>
 | |
| 
 | |
| #ifdef CONFIG_STATUS_LED
 | |
| # include <status_led.h>
 | |
| #endif
 | |
| 
 | |
| /* Current I/O Device	*/
 | |
| static int curr_device = -1;
 | |
| 
 | |
| int do_ide(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
 | |
| {
 | |
| 	int rcode = 0;
 | |
| 
 | |
| 	switch (argc) {
 | |
| 	case 0:
 | |
| 	case 1:
 | |
| 		return CMD_RET_USAGE;
 | |
| 	case 2:
 | |
| 		if (strncmp(argv[1], "res", 3) == 0) {
 | |
| 			puts("\nReset IDE"
 | |
| #ifdef CONFIG_IDE_8xx_DIRECT
 | |
| 			     " on PCMCIA " PCMCIA_SLOT_MSG
 | |
| #endif
 | |
| 			     ": ");
 | |
| 
 | |
| 			ide_init();
 | |
| 			return 0;
 | |
| 		} else if (strncmp(argv[1], "inf", 3) == 0) {
 | |
| 			blk_list_devices(IF_TYPE_IDE);
 | |
| 			return 0;
 | |
| 
 | |
| 		} else if (strncmp(argv[1], "dev", 3) == 0) {
 | |
| 			if (blk_print_device_num(IF_TYPE_IDE, curr_device)) {
 | |
| 				printf("\nno IDE devices available\n");
 | |
| 				return CMD_RET_FAILURE;
 | |
| 			}
 | |
| 
 | |
| 			return 0;
 | |
| 		} else if (strncmp(argv[1], "part", 4) == 0) {
 | |
| 			if (blk_list_part(IF_TYPE_IDE))
 | |
| 				printf("\nno IDE devices available\n");
 | |
| 			return 1;
 | |
| 		}
 | |
| 		return CMD_RET_USAGE;
 | |
| 	case 3:
 | |
| 		if (strncmp(argv[1], "dev", 3) == 0) {
 | |
| 			int dev = (int)simple_strtoul(argv[2], NULL, 10);
 | |
| 
 | |
| 			if (!blk_show_device(IF_TYPE_IDE, dev)) {
 | |
| 				curr_device = dev;
 | |
| 				printf("... is now current device\n");
 | |
| 			} else {
 | |
| 				return CMD_RET_FAILURE;
 | |
| 			}
 | |
| 			return 0;
 | |
| 		} else if (strncmp(argv[1], "part", 4) == 0) {
 | |
| 			int dev = (int)simple_strtoul(argv[2], NULL, 10);
 | |
| 
 | |
| 			if (blk_print_part_devnum(IF_TYPE_IDE, dev)) {
 | |
| 				printf("\nIDE device %d not available\n", dev);
 | |
| 				return CMD_RET_FAILURE;
 | |
| 			}
 | |
| 			return 1;
 | |
| 		}
 | |
| 
 | |
| 		return CMD_RET_USAGE;
 | |
| 	default:
 | |
| 		/* at least 4 args */
 | |
| 
 | |
| 		if (strcmp(argv[1], "read") == 0) {
 | |
| 			ulong addr = simple_strtoul(argv[2], NULL, 16);
 | |
| 			ulong cnt = simple_strtoul(argv[4], NULL, 16);
 | |
| 			ulong n;
 | |
| 
 | |
| #ifdef CONFIG_SYS_64BIT_LBA
 | |
| 			lbaint_t blk = simple_strtoull(argv[3], NULL, 16);
 | |
| 
 | |
| 			printf("\nIDE read: device %d block # %lld, count %ld...",
 | |
| 			       curr_device, blk, cnt);
 | |
| #else
 | |
| 			lbaint_t blk = simple_strtoul(argv[3], NULL, 16);
 | |
| 
 | |
| 			printf("\nIDE read: device %d block # %ld, count %ld...",
 | |
| 			       curr_device, blk, cnt);
 | |
| #endif
 | |
| 
 | |
| 			n = blk_read_devnum(IF_TYPE_IDE, curr_device, blk, cnt,
 | |
| 					    (ulong *)addr);
 | |
| 
 | |
| 			printf("%ld blocks read: %s\n",
 | |
| 			       n, (n == cnt) ? "OK" : "ERROR");
 | |
| 			if (n == cnt)
 | |
| 				return 0;
 | |
| 			else
 | |
| 				return 1;
 | |
| 		} else if (strcmp(argv[1], "write") == 0) {
 | |
| 			ulong addr = simple_strtoul(argv[2], NULL, 16);
 | |
| 			ulong cnt = simple_strtoul(argv[4], NULL, 16);
 | |
| 			ulong n;
 | |
| 
 | |
| #ifdef CONFIG_SYS_64BIT_LBA
 | |
| 			lbaint_t blk = simple_strtoull(argv[3], NULL, 16);
 | |
| 
 | |
| 			printf("\nIDE write: device %d block # %lld, count %ld...",
 | |
| 			       curr_device, blk, cnt);
 | |
| #else
 | |
| 			lbaint_t blk = simple_strtoul(argv[3], NULL, 16);
 | |
| 
 | |
| 			printf("\nIDE write: device %d block # %ld, count %ld...",
 | |
| 			       curr_device, blk, cnt);
 | |
| #endif
 | |
| 			n = blk_write_devnum(IF_TYPE_IDE, curr_device, blk, cnt,
 | |
| 					     (ulong *)addr);
 | |
| 
 | |
| 			printf("%ld blocks written: %s\n", n,
 | |
| 			       n == cnt ? "OK" : "ERROR");
 | |
| 			if (n == cnt)
 | |
| 				return 0;
 | |
| 			else
 | |
| 				return 1;
 | |
| 		} else {
 | |
| 			return CMD_RET_USAGE;
 | |
| 		}
 | |
| 
 | |
| 		return rcode;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| int do_diskboot(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
 | |
| {
 | |
| 	return common_diskboot(cmdtp, "ide", argc, argv);
 | |
| }
 | |
| 
 | |
| U_BOOT_CMD(ide, 5, 1, do_ide,
 | |
| 	   "IDE sub-system",
 | |
| 	   "reset - reset IDE controller\n"
 | |
| 	   "ide info  - show available IDE devices\n"
 | |
| 	   "ide device [dev] - show or set current device\n"
 | |
| 	   "ide part [dev] - print partition table of one or all IDE devices\n"
 | |
| 	   "ide read  addr blk# cnt\n"
 | |
| 	   "ide write addr blk# cnt - read/write `cnt'"
 | |
| 	   " blocks starting at block `blk#'\n"
 | |
| 	   "    to/from memory address `addr'");
 | |
| 
 | |
| U_BOOT_CMD(diskboot, 3, 1, do_diskboot,
 | |
| 	   "boot from IDE device", "loadAddr dev:part");
 |