|  | /* | 
|  | * (C) Copyright 2002 | 
|  | * Richard Jones, rjones@nexus-tech.net | 
|  | * | 
|  | * See file CREDITS for list of people who contributed to this | 
|  | * project. | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or | 
|  | * modify it under the terms of the GNU General Public License as | 
|  | * published by the Free Software Foundation; either version 2 of | 
|  | * the License, or (at your option) any later version. | 
|  | * | 
|  | * This program is distributed in the hope that it will be useful, | 
|  | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | * GNU General Public License for more details. | 
|  | * | 
|  | * You should have received a copy of the GNU General Public License | 
|  | * along with this program; if not, write to the Free Software | 
|  | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | 
|  | * MA 02111-1307 USA | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * Boot support | 
|  | */ | 
|  | #include <common.h> | 
|  | #include <command.h> | 
|  | #include <s_record.h> | 
|  | #include <net.h> | 
|  | #include <ata.h> | 
|  |  | 
|  | #if (CONFIG_COMMANDS & CFG_CMD_FAT) | 
|  |  | 
|  | #undef	DEBUG | 
|  |  | 
|  | #include <fat.h> | 
|  |  | 
|  |  | 
|  | block_dev_desc_t *get_dev (char* ifname, int dev) | 
|  | { | 
|  | #if (CONFIG_COMMANDS & CFG_CMD_IDE) | 
|  | if (strncmp(ifname,"ide",3)==0) { | 
|  | extern block_dev_desc_t * ide_get_dev(int dev); | 
|  | return(ide_get_dev(dev)); | 
|  | } | 
|  | #endif | 
|  | #if (CONFIG_COMMANDS & CFG_CMD_SCSI) | 
|  | if (strncmp(ifname,"scsi",4)==0) { | 
|  | extern block_dev_desc_t * scsi_get_dev(int dev); | 
|  | return(scsi_get_dev(dev)); | 
|  | } | 
|  | #endif | 
|  | #if ((CONFIG_COMMANDS & CFG_CMD_USB) && defined(CONFIG_USB_STORAGE)) | 
|  | if (strncmp(ifname,"usb",3)==0) { | 
|  | extern block_dev_desc_t * usb_stor_get_dev(int dev); | 
|  | return(usb_stor_get_dev(dev)); | 
|  | } | 
|  | #endif | 
|  | #if defined(CONFIG_MMC) | 
|  | if (strncmp(ifname,"mmc",3)==0) { | 
|  | extern block_dev_desc_t *  mmc_get_dev(int dev); | 
|  | return(mmc_get_dev(dev)); | 
|  | } | 
|  | #endif | 
|  | #if defined(CONFIG_SYSTEMACE) | 
|  | if (strcmp(ifname,"ace")==0) { | 
|  | extern block_dev_desc_t *  systemace_get_dev(int dev); | 
|  | return(systemace_get_dev(dev)); | 
|  | } | 
|  | #endif | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  |  | 
|  | int do_fat_fsload (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]) | 
|  | { | 
|  | long size; | 
|  | unsigned long offset; | 
|  | unsigned long count; | 
|  | char buf [12]; | 
|  | block_dev_desc_t *dev_desc=NULL; | 
|  | int dev=0; | 
|  | int part=1; | 
|  | char *ep; | 
|  |  | 
|  | if (argc < 5) { | 
|  | printf ("usage: fatload <interface> <dev[:part]> <addr> <filename> [bytes]\n"); | 
|  | return 1; | 
|  | } | 
|  | dev = (int)simple_strtoul (argv[2], &ep, 16); | 
|  | dev_desc=get_dev(argv[1],dev); | 
|  | if (dev_desc==NULL) { | 
|  | puts ("\n** Invalid boot device **\n"); | 
|  | return 1; | 
|  | } | 
|  | if (*ep) { | 
|  | if (*ep != ':') { | 
|  | puts ("\n** Invalid boot device, use `dev[:part]' **\n"); | 
|  | return 1; | 
|  | } | 
|  | part = (int)simple_strtoul(++ep, NULL, 16); | 
|  | } | 
|  | if (fat_register_device(dev_desc,part)!=0) { | 
|  | printf ("\n** Unable to use %s %d:%d for fatload **\n",argv[1],dev,part); | 
|  | return 1; | 
|  | } | 
|  | offset = simple_strtoul (argv[3], NULL, 16); | 
|  | if (argc == 6) | 
|  | count = simple_strtoul (argv[5], NULL, 16); | 
|  | else | 
|  | count = 0; | 
|  | size = file_fat_read (argv[4], (unsigned char *) offset, count); | 
|  |  | 
|  | if(size==-1) { | 
|  | printf("\n** Unable to read \"%s\" from %s %d:%d **\n",argv[4],argv[1],dev,part); | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | printf ("\n%ld bytes read\n", size); | 
|  |  | 
|  | sprintf(buf, "%lX", size); | 
|  | setenv("filesize", buf); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | U_BOOT_CMD( | 
|  | fatload,	6,	0,	do_fat_fsload, | 
|  | "fatload - load binary file from a dos filesystem\n", | 
|  | "<interface> <dev[:part]>  <addr> <filename> [bytes]\n" | 
|  | "    - load binary file 'filename' from 'dev' on 'interface'\n" | 
|  | "      to address 'addr' from dos filesystem\n" | 
|  | ); | 
|  |  | 
|  | int do_fat_ls (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]) | 
|  | { | 
|  | char *filename = "/"; | 
|  | int ret; | 
|  | int dev=0; | 
|  | int part=1; | 
|  | char *ep; | 
|  | block_dev_desc_t *dev_desc=NULL; | 
|  |  | 
|  | if (argc < 3) { | 
|  | printf ("usage: fatls <interface> <dev[:part]> [directory]\n"); | 
|  | return (0); | 
|  | } | 
|  | dev = (int)simple_strtoul (argv[2], &ep, 16); | 
|  | dev_desc=get_dev(argv[1],dev); | 
|  | if (dev_desc==NULL) { | 
|  | puts ("\n** Invalid boot device **\n"); | 
|  | return 1; | 
|  | } | 
|  | if (*ep) { | 
|  | if (*ep != ':') { | 
|  | puts ("\n** Invalid boot device, use `dev[:part]' **\n"); | 
|  | return 1; | 
|  | } | 
|  | part = (int)simple_strtoul(++ep, NULL, 16); | 
|  | } | 
|  | if (fat_register_device(dev_desc,part)!=0) { | 
|  | printf ("\n** Unable to use %s %d:%d for fatls **\n",argv[1],dev,part); | 
|  | return 1; | 
|  | } | 
|  | if (argc == 4) | 
|  | ret = file_fat_ls (argv[3]); | 
|  | else | 
|  | ret = file_fat_ls (filename); | 
|  |  | 
|  | if(ret!=0) | 
|  | printf("No Fat FS detected\n"); | 
|  | return (ret); | 
|  | } | 
|  |  | 
|  | U_BOOT_CMD( | 
|  | fatls,	4,	1,	do_fat_ls, | 
|  | "fatls   - list files in a directory (default /)\n", | 
|  | "<interface> <dev[:part]> [directory]\n" | 
|  | "    - list files from 'dev' on 'interface' in a 'directory'\n" | 
|  | ); | 
|  |  | 
|  | int do_fat_fsinfo (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]) | 
|  | { | 
|  | int dev=0; | 
|  | int part=1; | 
|  | char *ep; | 
|  | block_dev_desc_t *dev_desc=NULL; | 
|  |  | 
|  | if (argc < 2) { | 
|  | printf ("usage: fatinfo <interface> <dev[:part]>\n"); | 
|  | return (0); | 
|  | } | 
|  | dev = (int)simple_strtoul (argv[2], &ep, 16); | 
|  | dev_desc=get_dev(argv[1],dev); | 
|  | if (dev_desc==NULL) { | 
|  | puts ("\n** Invalid boot device **\n"); | 
|  | return 1; | 
|  | } | 
|  | if (*ep) { | 
|  | if (*ep != ':') { | 
|  | puts ("\n** Invalid boot device, use `dev[:part]' **\n"); | 
|  | return 1; | 
|  | } | 
|  | part = (int)simple_strtoul(++ep, NULL, 16); | 
|  | } | 
|  | if (fat_register_device(dev_desc,part)!=0) { | 
|  | printf ("\n** Unable to use %s %d:%d for fatinfo **\n",argv[1],dev,part); | 
|  | return 1; | 
|  | } | 
|  | return (file_fat_detectfs ()); | 
|  | } | 
|  |  | 
|  | U_BOOT_CMD( | 
|  | fatinfo,	3,	1,	do_fat_fsinfo, | 
|  | "fatinfo - print information about filesystem\n", | 
|  | "<interface> <dev[:part]>\n" | 
|  | "    - print information about filesystem from 'dev' on 'interface'\n" | 
|  | ); | 
|  |  | 
|  | #ifdef NOT_IMPLEMENTED_YET | 
|  | /* find first device whose first partition is a DOS filesystem */ | 
|  | int find_fat_partition (void) | 
|  | { | 
|  | int i, j; | 
|  | block_dev_desc_t *dev_desc; | 
|  | unsigned char *part_table; | 
|  | unsigned char buffer[ATA_BLOCKSIZE]; | 
|  |  | 
|  | for (i = 0; i < CFG_IDE_MAXDEVICE; i++) { | 
|  | dev_desc = ide_get_dev (i); | 
|  | if (!dev_desc) { | 
|  | debug ("couldn't get ide device!\n"); | 
|  | return (-1); | 
|  | } | 
|  | if (dev_desc->part_type == PART_TYPE_DOS) { | 
|  | if (dev_desc-> | 
|  | block_read (dev_desc->dev, 0, 1, (ulong *) buffer) != 1) { | 
|  | debug ("can't perform block_read!\n"); | 
|  | return (-1); | 
|  | } | 
|  | part_table = &buffer[0x1be];	/* start with partition #4 */ | 
|  | for (j = 0; j < 4; j++) { | 
|  | if ((part_table[4] == 1 ||	/* 12-bit FAT */ | 
|  | part_table[4] == 4 ||	/* 16-bit FAT */ | 
|  | part_table[4] == 6) &&	/* > 32Meg part */ | 
|  | part_table[0] == 0x80) {	/* bootable? */ | 
|  | curr_dev = i; | 
|  | part_offset = part_table[11]; | 
|  | part_offset <<= 8; | 
|  | part_offset |= part_table[10]; | 
|  | part_offset <<= 8; | 
|  | part_offset |= part_table[9]; | 
|  | part_offset <<= 8; | 
|  | part_offset |= part_table[8]; | 
|  | debug ("found partition start at %ld\n", part_offset); | 
|  | return (0); | 
|  | } | 
|  | part_table += 16; | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | debug ("no valid devices found!\n"); | 
|  | return (-1); | 
|  | } | 
|  |  | 
|  | int | 
|  | do_fat_dump (cmd_tbl_t *cmdtp, bd_t *bd, int flag, int argc, char *argv[]) | 
|  | { | 
|  | __u8 block[1024]; | 
|  | int ret; | 
|  | int bknum; | 
|  |  | 
|  | ret = 0; | 
|  |  | 
|  | if (argc != 2) { | 
|  | printf ("needs an argument!\n"); | 
|  | return (0); | 
|  | } | 
|  |  | 
|  | bknum = simple_strtoul (argv[1], NULL, 10); | 
|  |  | 
|  | if (disk_read (0, bknum, block) != 0) { | 
|  | printf ("Error: reading block\n"); | 
|  | return -1; | 
|  | } | 
|  | printf ("FAT dump: %d\n", bknum); | 
|  | hexdump (512, block); | 
|  |  | 
|  | return (ret); | 
|  | } | 
|  |  | 
|  | int disk_read (__u32 startblock, __u32 getsize, __u8 *bufptr) | 
|  | { | 
|  | ulong tot; | 
|  | block_dev_desc_t *dev_desc; | 
|  |  | 
|  | if (curr_dev < 0) { | 
|  | if (find_fat_partition () != 0) | 
|  | return (-1); | 
|  | } | 
|  |  | 
|  | dev_desc = ide_get_dev (curr_dev); | 
|  | if (!dev_desc) { | 
|  | debug ("couldn't get ide device\n"); | 
|  | return (-1); | 
|  | } | 
|  |  | 
|  | tot = dev_desc->block_read (0, startblock + part_offset, | 
|  | getsize, (ulong *) bufptr); | 
|  |  | 
|  | /* should we do this here? | 
|  | flush_cache ((ulong)buf, cnt*ide_dev_desc[device].blksz); | 
|  | */ | 
|  |  | 
|  | if (tot == getsize) | 
|  | return (0); | 
|  |  | 
|  | debug ("unable to read from device!\n"); | 
|  |  | 
|  | return (-1); | 
|  | } | 
|  |  | 
|  |  | 
|  | static int isprint (unsigned char ch) | 
|  | { | 
|  | if (ch >= 32 && ch < 127) | 
|  | return (1); | 
|  |  | 
|  | return (0); | 
|  | } | 
|  |  | 
|  |  | 
|  | void hexdump (int cnt, unsigned char *data) | 
|  | { | 
|  | int i; | 
|  | int run; | 
|  | int offset; | 
|  |  | 
|  | offset = 0; | 
|  | while (cnt) { | 
|  | printf ("%04X : ", offset); | 
|  | if (cnt >= 16) | 
|  | run = 16; | 
|  | else | 
|  | run = cnt; | 
|  | cnt -= run; | 
|  | for (i = 0; i < run; i++) | 
|  | printf ("%02X ", (unsigned int) data[i]); | 
|  | printf (": "); | 
|  | for (i = 0; i < run; i++) | 
|  | printf ("%c", isprint (data[i]) ? data[i] : '.'); | 
|  | printf ("\n"); | 
|  | data = &data[16]; | 
|  | offset += run; | 
|  | } | 
|  | } | 
|  | #endif	/* NOT_IMPLEMENTED_YET */ | 
|  |  | 
|  | #endif	/* CFG_CMD_FAT */ |