[people/ms/u-boot.git] / common / cmd_scsi.c

/*
 * (C) Copyright 2001
 * Denis Peter, MPL AG Switzerland
 *
 * 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
 *
 *
 *
 */

/*
 * SCSI support.
 */
#include <common.h>
#include <command.h>
#include <asm/processor.h>
#include <scsi.h>
#include <image.h>
#include <pci.h>

#if (CONFIG_COMMANDS & CFG_CMD_SCSI)

#ifdef CONFIG_SCSI_SYM53C8XX
#define SCSI_VEND_ID	0x1000
#ifndef CONFIG_SCSI_DEV_ID
#define SCSI_DEV_ID		0x0001
#else
#define SCSI_DEV_ID		CONFIG_SCSI_DEV_ID
#endif
#elif defined CONFIG_SATA_ULI5288

#define SCSI_VEND_ID 0x10b9
#define SCSI_DEV_ID  0x5288

#else
#error no scsi device defined
#endif


static ccb tempccb;	/* temporary scsi command buffer */

static unsigned char tempbuff[512]; /* temporary data buffer */

static int scsi_max_devs; /* number of highest available scsi device */

static int scsi_curr_dev; /* current device */

static block_dev_desc_t scsi_dev_desc[CFG_SCSI_MAX_DEVICE];

/********************************************************************************
 *  forward declerations of some Setup Routines
 */
void scsi_setup_test_unit_ready(ccb * pccb);
void scsi_setup_read_capacity(ccb * pccb);
void scsi_setup_read6(ccb * pccb, unsigned long start, unsigned short blocks);
void scsi_setup_read_ext(ccb * pccb, unsigned long start, unsigned short blocks);
void scsi_setup_inquiry(ccb * pccb);
void scsi_ident_cpy (unsigned char *dest, unsigned char *src, unsigned int len);


ulong scsi_read(int device, ulong blknr, ulong blkcnt, void *buffer);


/*********************************************************************************
 * (re)-scan the scsi bus and reports scsi device info
 * to the user if mode = 1
 */
void scsi_scan(int mode)
{
	unsigned char i,perq,modi,lun;
	unsigned long capacity,blksz;
	ccb* pccb=(ccb *)&tempccb;

	if(mode==1) {
		printf("scanning bus for devices...\n");
	}
	for(i=0;i<CFG_SCSI_MAX_DEVICE;i++) {
		scsi_dev_desc[i].target=0xff;
		scsi_dev_desc[i].lun=0xff;
		scsi_dev_desc[i].lba=0;
		scsi_dev_desc[i].blksz=0;
		scsi_dev_desc[i].type=DEV_TYPE_UNKNOWN;
		scsi_dev_desc[i].vendor[0]=0;
		scsi_dev_desc[i].product[0]=0;
		scsi_dev_desc[i].revision[0]=0;
		scsi_dev_desc[i].removable=FALSE;
		scsi_dev_desc[i].if_type=IF_TYPE_SCSI;
		scsi_dev_desc[i].dev=i;
		scsi_dev_desc[i].part_type=PART_TYPE_UNKNOWN;
		scsi_dev_desc[i].block_read=scsi_read;
	}
	scsi_max_devs=0;
	for(i=0;i<CFG_SCSI_MAX_SCSI_ID;i++) {
		pccb->target=i;
		for(lun=0;lun<CFG_SCSI_MAX_LUN;lun++) {
			pccb->lun=lun;
			pccb->pdata=(unsigned char *)&tempbuff;
			pccb->datalen=512;
			scsi_setup_inquiry(pccb);
			if(scsi_exec(pccb)!=TRUE) {
				if(pccb->contr_stat==SCSI_SEL_TIME_OUT) {
					debug ("Selection timeout ID %d\n",pccb->target);
					continue; /* selection timeout => assuming no device present */
				}
				scsi_print_error(pccb);
				continue;
			}
			perq=tempbuff[0];
			modi=tempbuff[1];
			if((perq & 0x1f)==0x1f) {
				continue; /* skip unknown devices */
			}
			if((modi&0x80)==0x80) /* drive is removable */
				scsi_dev_desc[scsi_max_devs].removable=TRUE;
			/* get info for this device */
			scsi_ident_cpy(&scsi_dev_desc[scsi_max_devs].vendor[0],&tempbuff[8],8);
			scsi_ident_cpy(&scsi_dev_desc[scsi_max_devs].product[0],&tempbuff[16],16);
			scsi_ident_cpy(&scsi_dev_desc[scsi_max_devs].revision[0],&tempbuff[32],4);
			scsi_dev_desc[scsi_max_devs].target=pccb->target;
			scsi_dev_desc[scsi_max_devs].lun=pccb->lun;

			pccb->datalen=0;
			scsi_setup_test_unit_ready(pccb);
			if(scsi_exec(pccb)!=TRUE) {
				if(scsi_dev_desc[scsi_max_devs].removable==TRUE) {
					scsi_dev_desc[scsi_max_devs].type=perq;
					goto removable;
				}
				scsi_print_error(pccb);
				continue;
			}
			pccb->datalen=8;
			scsi_setup_read_capacity(pccb);
			if(scsi_exec(pccb)!=TRUE) {
				scsi_print_error(pccb);
				continue;
			}
			capacity=((unsigned long)tempbuff[0]<<24)|((unsigned long)tempbuff[1]<<16)|
					((unsigned long)tempbuff[2]<<8)|((unsigned long)tempbuff[3]);
			blksz=((unsigned long)tempbuff[4]<<24)|((unsigned long)tempbuff[5]<<16)|
				((unsigned long)tempbuff[6]<<8)|((unsigned long)tempbuff[7]);
			scsi_dev_desc[scsi_max_devs].lba=capacity;
			scsi_dev_desc[scsi_max_devs].blksz=blksz;
			scsi_dev_desc[scsi_max_devs].type=perq;
			init_part(&scsi_dev_desc[scsi_max_devs]);
removable:
			if(mode==1) {
				printf ("  Device %d: ", scsi_max_devs);
				dev_print(&scsi_dev_desc[scsi_max_devs]);
			} /* if mode */
			scsi_max_devs++;
		} /* next LUN */
	}
	if(scsi_max_devs>0)
		scsi_curr_dev=0;
	else
		scsi_curr_dev=-1;
}


void scsi_init(void)
{
	int busdevfunc;

	busdevfunc=pci_find_device(SCSI_VEND_ID,SCSI_DEV_ID,0); /* get PCI Device ID */
	if(busdevfunc==-1) {
		printf("Error SCSI Controller (%04X,%04X) not found\n",SCSI_VEND_ID,SCSI_DEV_ID);
		return;
	}
#ifdef DEBUG
	else {
		printf("SCSI Controller (%04X,%04X) found (%d:%d:%d)\n",SCSI_VEND_ID,SCSI_DEV_ID,(busdevfunc>>16)&0xFF,(busdevfunc>>11)&0x1F,(busdevfunc>>8)&0x7);
	}
#endif
	scsi_low_level_init(busdevfunc);
	scsi_scan(1);
}

block_dev_desc_t * scsi_get_dev(int dev)
{
	return (dev < CFG_SCSI_MAX_DEVICE) ? &scsi_dev_desc[dev] : NULL;
}


/******************************************************************************
 * scsi boot command intepreter. Derived from diskboot
 */
int do_scsiboot (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
{
	char *boot_device = NULL;
	char *ep;
	int dev, part = 0;
	ulong addr, cnt, checksum;
	disk_partition_t info;
	image_header_t *hdr;
	int rcode = 0;

	switch (argc) {
	case 1:
		addr = CFG_LOAD_ADDR;
		boot_device = getenv ("bootdevice");
		break;
	case 2:
		addr = simple_strtoul(argv[1], NULL, 16);
		boot_device = getenv ("bootdevice");
		break;
	case 3:
		addr = simple_strtoul(argv[1], NULL, 16);
		boot_device = argv[2];
		break;
	default:
		printf ("Usage:\n%s\n", cmdtp->usage);
		return 1;
	}

	if (!boot_device) {
		puts ("\n** No boot device **\n");
		return 1;
	}

	dev = simple_strtoul(boot_device, &ep, 16);
	printf("booting from dev %d\n",dev);
	if (scsi_dev_desc[dev].type == DEV_TYPE_UNKNOWN) {
		printf ("\n** Device %d not available\n", dev);
		return 1;
	}

	if (*ep) {
		if (*ep != ':') {
			puts ("\n** Invalid boot device, use `dev[:part]' **\n");
			return 1;
		}
		part = simple_strtoul(++ep, NULL, 16);
	}
	if (get_partition_info (&scsi_dev_desc[dev], part, &info)) {
		printf("error reading partinfo\n");
		return 1;
	}
	if ((strncmp((char *)(info.type), BOOT_PART_TYPE, sizeof(info.type)) != 0) &&
	    (strncmp((char *)(info.type), BOOT_PART_COMP, sizeof(info.type)) != 0)) {
		printf ("\n** Invalid partition type \"%.32s\""
			" (expect \"" BOOT_PART_TYPE "\")\n",
			info.type);
		return 1;
	}

	printf ("\nLoading from SCSI device %d, partition %d: "
		"Name: %.32s  Type: %.32s\n",
		dev, part, info.name, info.type);

	debug ("First Block: %ld,  # of blocks: %ld, Block Size: %ld\n",
		info.start, info.size, info.blksz);

	if (scsi_read (dev, info.start, 1, (ulong *)addr) != 1) {
		printf ("** Read error on %d:%d\n", dev, part);
		return 1;
	}

	hdr = (image_header_t *)addr;

	if (ntohl(hdr->ih_magic) == IH_MAGIC) {
		printf("\n** Bad Magic Number **\n");
		return 1;
	}

	checksum = ntohl(hdr->ih_hcrc);
	hdr->ih_hcrc = 0;

	if (crc32 (0, (uchar *)hdr, sizeof(image_header_t)) != checksum) {
		puts ("\n** Bad Header Checksum **\n");
		return 1;
	}
	hdr->ih_hcrc = htonl(checksum);	/* restore checksum for later use */

	print_image_hdr (hdr);
	cnt = (ntohl(hdr->ih_size) + sizeof(image_header_t));
	cnt += info.blksz - 1;
	cnt /= info.blksz;
	cnt -= 1;

	if (scsi_read (dev, info.start+1, cnt,
		      (ulong *)(addr+info.blksz)) != cnt) {
		printf ("** Read error on %d:%d\n", dev, part);
		return 1;
	}
	/* Loading ok, update default load address */
	load_addr = addr;

	flush_cache (addr, (cnt+1)*info.blksz);

	/* Check if we should attempt an auto-start */
	if (((ep = getenv("autostart")) != NULL) && (strcmp(ep,"yes") == 0)) {
		char *local_args[2];
		extern int do_bootm (cmd_tbl_t *, int, int, char *[]);
		local_args[0] = argv[0];
		local_args[1] = NULL;
		printf ("Automatic boot of image at addr 0x%08lX ...\n", addr);
		rcode = do_bootm (cmdtp, 0, 1, local_args);
	}
	 return rcode;
}

/*********************************************************************************
 * scsi command intepreter
 */
int do_scsi (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
{
	switch (argc) {
    case 0:
    case 1:	printf ("Usage:\n%s\n", cmdtp->usage);	return 1;
    case 2:
			if (strncmp(argv[1],"res",3) == 0) {
				printf("\nReset SCSI\n");
				scsi_bus_reset();
				scsi_scan(1);
				return 0;
			}
			if (strncmp(argv[1],"inf",3) == 0) {
				int i;
				for (i=0; i<CFG_SCSI_MAX_DEVICE; ++i) {
					if(scsi_dev_desc[i].type==DEV_TYPE_UNKNOWN)
						continue; /* list only known devices */
					printf ("SCSI dev. %d:  ", i);
					dev_print(&scsi_dev_desc[i]);
				}
				return 0;
			}
			if (strncmp(argv[1],"dev",3) == 0) {
				if ((scsi_curr_dev < 0) || (scsi_curr_dev >= CFG_SCSI_MAX_DEVICE)) {
					printf("\nno SCSI devices available\n");
					return 1;
				}
				printf ("\n    Device %d: ", scsi_curr_dev);
				dev_print(&scsi_dev_desc[scsi_curr_dev]);
				return 0;
			}
			if (strncmp(argv[1],"scan",4) == 0) {
				scsi_scan(1);
				return 0;
			}
			if (strncmp(argv[1],"part",4) == 0) {
				int dev, ok;
				for (ok=0, dev=0; dev<CFG_SCSI_MAX_DEVICE; ++dev) {
					if (scsi_dev_desc[dev].type!=DEV_TYPE_UNKNOWN) {
						ok++;
						if (dev)
							printf("\n");
						debug ("print_part of %x\n",dev);
							print_part(&scsi_dev_desc[dev]);
					}
				}
				if (!ok)
					printf("\nno SCSI devices available\n");
				return 1;
			}
			printf ("Usage:\n%s\n", cmdtp->usage);
			return 1;
  	case 3:
			if (strncmp(argv[1],"dev",3) == 0) {
				int dev = (int)simple_strtoul(argv[2], NULL, 10);
				printf ("\nSCSI device %d: ", dev);
				if (dev >= CFG_SCSI_MAX_DEVICE) {
					printf("unknown device\n");
					return 1;
				}
				printf ("\n    Device %d: ", dev);
				dev_print(&scsi_dev_desc[dev]);
				if(scsi_dev_desc[dev].type == DEV_TYPE_UNKNOWN) {
					return 1;
				}
				scsi_curr_dev = dev;
				printf("... is now current device\n");
				return 0;
			}
			if (strncmp(argv[1],"part",4) == 0) {
				int dev = (int)simple_strtoul(argv[2], NULL, 10);
				if(scsi_dev_desc[dev].type != DEV_TYPE_UNKNOWN) {
					print_part(&scsi_dev_desc[dev]);
				}
				else {
					printf ("\nSCSI device %d not available\n", dev);
				}
				return 1;
			}
			printf ("Usage:\n%s\n", cmdtp->usage);
			return 1;
    default:
			/* at least 4 args */
			if (strcmp(argv[1],"read") == 0) {
				ulong addr = simple_strtoul(argv[2], NULL, 16);
				ulong blk  = simple_strtoul(argv[3], NULL, 16);
				ulong cnt  = simple_strtoul(argv[4], NULL, 16);
				ulong n;
				printf ("\nSCSI read: device %d block # %ld, count %ld ... ",
						scsi_curr_dev, blk, cnt);
				n = scsi_read(scsi_curr_dev, blk, cnt, (ulong *)addr);
				printf ("%ld blocks read: %s\n",n,(n==cnt) ? "OK" : "ERROR");
				return 0;
			}
	} /* switch */
	printf ("Usage:\n%s\n", cmdtp->usage);
	return 1;
}

/****************************************************************************************
 * scsi_read
 */

#define SCSI_MAX_READ_BLK 0xFFFF /* almost the maximum amount of the scsi_ext command.. */

ulong scsi_read(int device, ulong blknr, ulong blkcnt, void *buffer)
{
	ulong start,blks, buf_addr;
	unsigned short smallblks;
	ccb* pccb=(ccb *)&tempccb;
	device&=0xff;
	/* Setup  device
	 */
	pccb->target=scsi_dev_desc[device].target;
	pccb->lun=scsi_dev_desc[device].lun;
	buf_addr=(unsigned long)buffer;
	start=blknr;
	blks=blkcnt;
	debug ("\nscsi_read: dev %d startblk %lx, blccnt %lx buffer %lx\n",device,start,blks,(unsigned long)buffer);
	do {
		pccb->pdata=(unsigned char *)buf_addr;
		if(blks>SCSI_MAX_READ_BLK) {
			pccb->datalen=scsi_dev_desc[device].blksz * SCSI_MAX_READ_BLK;
			smallblks=SCSI_MAX_READ_BLK;
			scsi_setup_read_ext(pccb,start,smallblks);
			start+=SCSI_MAX_READ_BLK;
			blks-=SCSI_MAX_READ_BLK;
		}
		else {
			pccb->datalen=scsi_dev_desc[device].blksz * blks;
			smallblks=(unsigned short) blks;
			scsi_setup_read_ext(pccb,start,smallblks);
			start+=blks;
			blks=0;
		}
		debug ("scsi_read_ext: startblk %lx, blccnt %x buffer %lx\n",start,smallblks,buf_addr);
		if(scsi_exec(pccb)!=TRUE) {
			scsi_print_error(pccb);
			blkcnt-=blks;
			break;
		}
		buf_addr+=pccb->datalen;
	} while(blks!=0);
	debug ("scsi_read_ext: end startblk %lx, blccnt %x buffer %lx\n",start,smallblks,buf_addr);
	return(blkcnt);
}

/* copy src to dest, skipping leading and trailing blanks
 * and null terminate the string
 */
void scsi_ident_cpy (unsigned char *dest, unsigned char *src, unsigned int len)
{
	int start,end;

	start=0;
	while(start<len) {
		if(src[start]!=' ')
			break;
		start++;
	}
	end=len-1;
	while(end>start) {
		if(src[end]!=' ')
			break;
		end--;
	}
	for( ; start<=end; start++) {
		*dest++=src[start];
	}
	*dest='\0';
}


/* Trim trailing blanks, and NUL-terminate string
 */
void scsi_trim_trail (unsigned char *str, unsigned int len)
{
	unsigned char *p = str + len - 1;

	while (len-- > 0) {
		*p-- = '\0';
		if (*p != ' ') {
			return;
		}
	}
}


/************************************************************************************
 * Some setup (fill-in) routines
 */
void scsi_setup_test_unit_ready(ccb * pccb)
{
	pccb->cmd[0]=SCSI_TST_U_RDY;
	pccb->cmd[1]=pccb->lun<<5;
	pccb->cmd[2]=0;
	pccb->cmd[3]=0;
	pccb->cmd[4]=0;
	pccb->cmd[5]=0;
	pccb->cmdlen=6;
	pccb->msgout[0]=SCSI_IDENTIFY; /* NOT USED */
}

void scsi_setup_read_capacity(ccb * pccb)
{
	pccb->cmd[0]=SCSI_RD_CAPAC;
	pccb->cmd[1]=pccb->lun<<5;
	pccb->cmd[2]=0;
	pccb->cmd[3]=0;
	pccb->cmd[4]=0;
	pccb->cmd[5]=0;
	pccb->cmd[6]=0;
	pccb->cmd[7]=0;
	pccb->cmd[8]=0;
	pccb->cmd[9]=0;
	pccb->cmdlen=10;
	pccb->msgout[0]=SCSI_IDENTIFY; /* NOT USED */

}

void scsi_setup_read_ext(ccb * pccb, unsigned long start, unsigned short blocks)
{
	pccb->cmd[0]=SCSI_READ10;
	pccb->cmd[1]=pccb->lun<<5;
	pccb->cmd[2]=((unsigned char) (start>>24))&0xff;
	pccb->cmd[3]=((unsigned char) (start>>16))&0xff;
	pccb->cmd[4]=((unsigned char) (start>>8))&0xff;
	pccb->cmd[5]=((unsigned char) (start))&0xff;
	pccb->cmd[6]=0;
	pccb->cmd[7]=((unsigned char) (blocks>>8))&0xff;
	pccb->cmd[8]=(unsigned char) blocks & 0xff;
	pccb->cmd[6]=0;
	pccb->cmdlen=10;
	pccb->msgout[0]=SCSI_IDENTIFY; /* NOT USED */
	debug ("scsi_setup_read_ext: cmd: %02X %02X startblk %02X%02X%02X%02X blccnt %02X%02X\n",
		pccb->cmd[0],pccb->cmd[1],
		pccb->cmd[2],pccb->cmd[3],pccb->cmd[4],pccb->cmd[5],
		pccb->cmd[7],pccb->cmd[8]);
}

void scsi_setup_read6(ccb * pccb, unsigned long start, unsigned short blocks)
{
	pccb->cmd[0]=SCSI_READ6;
	pccb->cmd[1]=pccb->lun<<5 | (((unsigned char)(start>>16))&0x1f);
	pccb->cmd[2]=((unsigned char) (start>>8))&0xff;
	pccb->cmd[3]=((unsigned char) (start))&0xff;
	pccb->cmd[4]=(unsigned char) blocks & 0xff;
	pccb->cmd[5]=0;
	pccb->cmdlen=6;
	pccb->msgout[0]=SCSI_IDENTIFY; /* NOT USED */
	debug ("scsi_setup_read6: cmd: %02X %02X startblk %02X%02X blccnt %02X\n",
		pccb->cmd[0],pccb->cmd[1],
		pccb->cmd[2],pccb->cmd[3],pccb->cmd[4]);
}


void scsi_setup_inquiry(ccb * pccb)
{
	pccb->cmd[0]=SCSI_INQUIRY;
	pccb->cmd[1]=pccb->lun<<5;
	pccb->cmd[2]=0;
	pccb->cmd[3]=0;
	if(pccb->datalen>255)
		pccb->cmd[4]=255;
	else
		pccb->cmd[4]=(unsigned char)pccb->datalen;
	pccb->cmd[5]=0;
	pccb->cmdlen=6;
	pccb->msgout[0]=SCSI_IDENTIFY; /* NOT USED */
}


U_BOOT_CMD(
	scsi, 5, 1, do_scsi,
	"scsi    - SCSI sub-system\n",
	"reset - reset SCSI controller\n"
	"scsi info  - show available SCSI devices\n"
	"scsi scan  - (re-)scan SCSI bus\n"
	"scsi device [dev] - show or set current device\n"
	"scsi part [dev] - print partition table of one or all SCSI devices\n"
	"scsi read addr blk# cnt - read `cnt' blocks starting at block `blk#'\n"
	"     to memory address `addr'\n"
);

U_BOOT_CMD(
	scsiboot, 3, 1, do_scsiboot,
	"scsiboot- boot from SCSI device\n",
	"loadAddr dev:part\n"
);

#endif /* #if (CONFIG_COMMANDS & CFG_CMD_SCSI) */
Commit	Line	Data
e887afc9 WD	1	/*
	2	* (C) Copyright 2001
	3	* Denis Peter, MPL AG Switzerland
	4	*
	5	* See file CREDITS for list of people who contributed to this
	6	* project.
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License as
	10	* published by the Free Software Foundation; either version 2 of
	11	* the License, or (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	21	* MA 02111-1307 USA
	22	*
	23	*
	24	*
	25	*/
	26
	27	/*
	28	* SCSI support.
	29	*/
e887afc9 WD	30	#include <common.h>
e887afc9 WD	31	#include <command.h>
e887afc9 WD	32	#include <asm/processor.h>
	33	#include <scsi.h>
	34	#include <image.h>
e887afc9 WD	35	#include <pci.h>
e887afc9 WD	36
e887afc9 WD	37	#if (CONFIG_COMMANDS & CFG_CMD_SCSI)
	38
	39	#ifdef CONFIG_SCSI_SYM53C8XX
	40	#define SCSI_VEND_ID 0x1000
	41	#ifndef CONFIG_SCSI_DEV_ID
	42	#define SCSI_DEV_ID 0x0001
	43	#else
	44	#define SCSI_DEV_ID CONFIG_SCSI_DEV_ID
	45	#endif
4782ac80 JZ	46	#elif defined CONFIG_SATA_ULI5288
	47
	48	#define SCSI_VEND_ID 0x10b9
	49	#define SCSI_DEV_ID 0x5288
	50
e887afc9	51	#else
4782ac80	52	#error no scsi device defined
e887afc9 WD	53	#endif
	54
	55
	56	static ccb tempccb; /* temporary scsi command buffer */
	57
	58	static unsigned char tempbuff[512]; /* temporary data buffer */
	59
	60	static int scsi_max_devs; /* number of highest available scsi device */
	61
	62	static int scsi_curr_dev; /* current device */
	63
	64	static block_dev_desc_t scsi_dev_desc[CFG_SCSI_MAX_DEVICE];
	65
	66	/********************************************************************************
	67	* forward declerations of some Setup Routines
	68	*/
	69	void scsi_setup_test_unit_ready(ccb * pccb);
	70	void scsi_setup_read_capacity(ccb * pccb);
	71	void scsi_setup_read6(ccb * pccb, unsigned long start, unsigned short blocks);
	72	void scsi_setup_read_ext(ccb * pccb, unsigned long start, unsigned short blocks);
	73	void scsi_setup_inquiry(ccb * pccb);
	74	void scsi_ident_cpy (unsigned char dest, unsigned char src, unsigned int len);
	75
	76
eb867a76	77	ulong scsi_read(int device, ulong blknr, ulong blkcnt, void *buffer);
e887afc9 WD	78
	79
	80	/*********************************************************************************
	81	* (re)-scan the scsi bus and reports scsi device info
	82	* to the user if mode = 1
	83	*/
	84	void scsi_scan(int mode)
	85	{
	86	unsigned char i,perq,modi,lun;
	87	unsigned long capacity,blksz;
	88	ccb* pccb=(ccb *)&tempccb;
	89
	90	if(mode==1) {
	91	printf("scanning bus for devices...\n");
	92	}
	93	for(i=0;i<CFG_SCSI_MAX_DEVICE;i++) {
	94	scsi_dev_desc[i].target=0xff;
	95	scsi_dev_desc[i].lun=0xff;
	96	scsi_dev_desc[i].lba=0;
	97	scsi_dev_desc[i].blksz=0;
	98	scsi_dev_desc[i].type=DEV_TYPE_UNKNOWN;
	99	scsi_dev_desc[i].vendor[0]=0;
	100	scsi_dev_desc[i].product[0]=0;
	101	scsi_dev_desc[i].revision[0]=0;
	102	scsi_dev_desc[i].removable=FALSE;
	103	scsi_dev_desc[i].if_type=IF_TYPE_SCSI;
	104	scsi_dev_desc[i].dev=i;
	105	scsi_dev_desc[i].part_type=PART_TYPE_UNKNOWN;
	106	scsi_dev_desc[i].block_read=scsi_read;
	107	}
	108	scsi_max_devs=0;
	109	for(i=0;i<CFG_SCSI_MAX_SCSI_ID;i++) {
	110	pccb->target=i;
	111	for(lun=0;lun<CFG_SCSI_MAX_LUN;lun++) {
	112	pccb->lun=lun;
	113	pccb->pdata=(unsigned char *)&tempbuff;
	114	pccb->datalen=512;
	115	scsi_setup_inquiry(pccb);
	116	if(scsi_exec(pccb)!=TRUE) {
	117	if(pccb->contr_stat==SCSI_SEL_TIME_OUT) {
1a344f29	118	debug ("Selection timeout ID %d\n",pccb->target);
e887afc9 WD	119	continue; /* selection timeout => assuming no device present */
	120	}
	121	scsi_print_error(pccb);
	122	continue;
	123	}
	124	perq=tempbuff[0];
	125	modi=tempbuff[1];
	126	if((perq & 0x1f)==0x1f) {
	127	continue; /* skip unknown devices */
	128	}
	129	if((modi&0x80)==0x80) /* drive is removable */
	130	scsi_dev_desc[scsi_max_devs].removable=TRUE;
	131	/* get info for this device */
	132	scsi_ident_cpy(&scsi_dev_desc[scsi_max_devs].vendor[0],&tempbuff[8],8);
	133	scsi_ident_cpy(&scsi_dev_desc[scsi_max_devs].product[0],&tempbuff[16],16);
	134	scsi_ident_cpy(&scsi_dev_desc[scsi_max_devs].revision[0],&tempbuff[32],4);
	135	scsi_dev_desc[scsi_max_devs].target=pccb->target;
	136	scsi_dev_desc[scsi_max_devs].lun=pccb->lun;
	137
	138	pccb->datalen=0;
	139	scsi_setup_test_unit_ready(pccb);
	140	if(scsi_exec(pccb)!=TRUE) {
	141	if(scsi_dev_desc[scsi_max_devs].removable==TRUE) {
	142	scsi_dev_desc[scsi_max_devs].type=perq;
	143	goto removable;
	144	}
	145	scsi_print_error(pccb);
	146	continue;
	147	}
	148	pccb->datalen=8;
	149	scsi_setup_read_capacity(pccb);
	150	if(scsi_exec(pccb)!=TRUE) {
	151	scsi_print_error(pccb);
	152	continue;
	153	}
	154	capacity=((unsigned long)tempbuff[0]<<24)\|((unsigned long)tempbuff[1]<<16)\|
	155	((unsigned long)tempbuff[2]<<8)\|((unsigned long)tempbuff[3]);
	156	blksz=((unsigned long)tempbuff[4]<<24)\|((unsigned long)tempbuff[5]<<16)\|
	157	((unsigned long)tempbuff[6]<<8)\|((unsigned long)tempbuff[7]);
	158	scsi_dev_desc[scsi_max_devs].lba=capacity;
	159	scsi_dev_desc[scsi_max_devs].blksz=blksz;
	160	scsi_dev_desc[scsi_max_devs].type=perq;
	161	init_part(&scsi_dev_desc[scsi_max_devs]);
	162	removable:
	163	if(mode==1) {
	164	printf (" Device %d: ", scsi_max_devs);
	165	dev_print(&scsi_dev_desc[scsi_max_devs]);
	166	} /* if mode */
	167	scsi_max_devs++;
	168	} /* next LUN */
	169	}
	170	if(scsi_max_devs>0)
	171	scsi_curr_dev=0;
	172	else
	173	scsi_curr_dev=-1;
	174	}
	175
	176
e887afc9 WD	177	void scsi_init(void)
	178	{
	179	int busdevfunc;
	180
	181	busdevfunc=pci_find_device(SCSI_VEND_ID,SCSI_DEV_ID,0); /* get PCI Device ID */
	182	if(busdevfunc==-1) {
	183	printf("Error SCSI Controller (%04X,%04X) not found\n",SCSI_VEND_ID,SCSI_DEV_ID);
	184	return;
	185	}
	186	#ifdef DEBUG
	187	else {
	188	printf("SCSI Controller (%04X,%04X) found (%d:%d:%d)\n",SCSI_VEND_ID,SCSI_DEV_ID,(busdevfunc>>16)&0xFF,(busdevfunc>>11)&0x1F,(busdevfunc>>8)&0x7);
	189	}
	190	#endif
	191	scsi_low_level_init(busdevfunc);
	192	scsi_scan(1);
	193	}
	194
	195	block_dev_desc_t * scsi_get_dev(int dev)
	196	{
735dd97b	197	return (dev < CFG_SCSI_MAX_DEVICE) ? &scsi_dev_desc[dev] : NULL;
e887afc9 WD	198	}
	199
	200
e887afc9 WD	201	/******************************************************************************
	202	* scsi boot command intepreter. Derived from diskboot
	203	*/
	204	int do_scsiboot (cmd_tbl_t cmdtp, int flag, int argc, char argv[])
	205	{
	206	char *boot_device = NULL;
	207	char *ep;
	208	int dev, part = 0;
1a344f29	209	ulong addr, cnt, checksum;
e887afc9 WD	210	disk_partition_t info;
	211	image_header_t *hdr;
	212	int rcode = 0;
	213
	214	switch (argc) {
	215	case 1:
	216	addr = CFG_LOAD_ADDR;
	217	boot_device = getenv ("bootdevice");
	218	break;
	219	case 2:
	220	addr = simple_strtoul(argv[1], NULL, 16);
	221	boot_device = getenv ("bootdevice");
	222	break;
	223	case 3:
	224	addr = simple_strtoul(argv[1], NULL, 16);
	225	boot_device = argv[2];
	226	break;
	227	default:
	228	printf ("Usage:\n%s\n", cmdtp->usage);
	229	return 1;
	230	}
	231
	232	if (!boot_device) {
	233	puts ("\n No boot device \n");
	234	return 1;
	235	}
	236
	237	dev = simple_strtoul(boot_device, &ep, 16);
	238	printf("booting from dev %d\n",dev);
	239	if (scsi_dev_desc[dev].type == DEV_TYPE_UNKNOWN) {
	240	printf ("\n** Device %d not available\n", dev);
	241	return 1;
	242	}
	243
	244	if (*ep) {
	245	if (*ep != ':') {
	246	puts ("\n Invalid boot device, use `dev[:part]' \n");
	247	return 1;
	248	}
	249	part = simple_strtoul(++ep, NULL, 16);
	250	}
7882751c	251	if (get_partition_info (&scsi_dev_desc[dev], part, &info)) {
e887afc9 WD	252	printf("error reading partinfo\n");
	253	return 1;
	254	}
77ddac94 WD	255	if ((strncmp((char *)(info.type), BOOT_PART_TYPE, sizeof(info.type)) != 0) &&
77ddac94 WD	256	(strncmp((char *)(info.type), BOOT_PART_COMP, sizeof(info.type)) != 0)) {
e887afc9 WD	257	printf ("\n** Invalid partition type \"%.32s\""
	258	" (expect \"" BOOT_PART_TYPE "\")\n",
	259	info.type);
	260	return 1;
	261	}
	262
	263	printf ("\nLoading from SCSI device %d, partition %d: "
	264	"Name: %.32s Type: %.32s\n",
	265	dev, part, info.name, info.type);
	266
1a344f29	267	debug ("First Block: %ld, # of blocks: %ld, Block Size: %ld\n",
e887afc9 WD	268	info.start, info.size, info.blksz);
	269
	270	if (scsi_read (dev, info.start, 1, (ulong *)addr) != 1) {
	271	printf ("** Read error on %d:%d\n", dev, part);
	272	return 1;
	273	}
	274
	275	hdr = (image_header_t *)addr;
	276
f8883cb1	277	if (ntohl(hdr->ih_magic) == IH_MAGIC) {
e887afc9 WD	278	printf("\n Bad Magic Number \n");
	279	return 1;
	280	}
	281
1a344f29 WD	282	checksum = ntohl(hdr->ih_hcrc);
	283	hdr->ih_hcrc = 0;
	284
77ddac94	285	if (crc32 (0, (uchar *)hdr, sizeof(image_header_t)) != checksum) {
1a344f29 WD	286	puts ("\n Bad Header Checksum \n");
	287	return 1;
	288	}
2f916943	289	hdr->ih_hcrc = htonl(checksum); /* restore checksum for later use */
1a344f29 WD	290
1a344f29 WD	291	print_image_hdr (hdr);
f8883cb1	292	cnt = (ntohl(hdr->ih_size) + sizeof(image_header_t));
1a344f29 WD	293	cnt += info.blksz - 1;
	294	cnt /= info.blksz;
	295	cnt -= 1;
	296
e887afc9 WD	297	if (scsi_read (dev, info.start+1, cnt,
	298	(ulong *)(addr+info.blksz)) != cnt) {
	299	printf ("** Read error on %d:%d\n", dev, part);
	300	return 1;
	301	}
	302	/* Loading ok, update default load address */
	303	load_addr = addr;
	304
	305	flush_cache (addr, (cnt+1)*info.blksz);
	306
	307	/* Check if we should attempt an auto-start */
	308	if (((ep = getenv("autostart")) != NULL) && (strcmp(ep,"yes") == 0)) {
	309	char *local_args[2];
	310	extern int do_bootm (cmd_tbl_t , int, int, char []);
	311	local_args[0] = argv[0];
	312	local_args[1] = NULL;
	313	printf ("Automatic boot of image at addr 0x%08lX ...\n", addr);
	314	rcode = do_bootm (cmdtp, 0, 1, local_args);
	315	}
	316	return rcode;
	317	}
	318
	319	/*********************************************************************************
	320	* scsi command intepreter
	321	*/
	322	int do_scsi (cmd_tbl_t cmdtp, int flag, int argc, char argv[])
	323	{
	324	switch (argc) {
	325	case 0:
	326	case 1: printf ("Usage:\n%s\n", cmdtp->usage); return 1;
	327	case 2:
	328	if (strncmp(argv[1],"res",3) == 0) {
	329	printf("\nReset SCSI\n");
	330	scsi_bus_reset();
	331	scsi_scan(1);
	332	return 0;
	333	}
	334	if (strncmp(argv[1],"inf",3) == 0) {
	335	int i;
	336	for (i=0; i<CFG_SCSI_MAX_DEVICE; ++i) {
	337	if(scsi_dev_desc[i].type==DEV_TYPE_UNKNOWN)
	338	continue; /* list only known devices */
	339	printf ("SCSI dev. %d: ", i);
	340	dev_print(&scsi_dev_desc[i]);
	341	}
	342	return 0;
	343	}
	344	if (strncmp(argv[1],"dev",3) == 0) {
	345	if ((scsi_curr_dev < 0) \|\| (scsi_curr_dev >= CFG_SCSI_MAX_DEVICE)) {
	346	printf("\nno SCSI devices available\n");
	347	return 1;
	348	}
	349	printf ("\n Device %d: ", scsi_curr_dev);
	350	dev_print(&scsi_dev_desc[scsi_curr_dev]);
	351	return 0;
	352	}
	353	if (strncmp(argv[1],"scan",4) == 0) {
	354	scsi_scan(1);
	355	return 0;
	356	}
	357	if (strncmp(argv[1],"part",4) == 0) {
	358	int dev, ok;
	359	for (ok=0, dev=0; dev<CFG_SCSI_MAX_DEVICE; ++dev) {
	360	if (scsi_dev_desc[dev].type!=DEV_TYPE_UNKNOWN) {
361	ok++;
362	if (dev)
363	printf("\n");
1a344f29	364	debug ("print_part of %x\n",dev);
e887afc9 WD	365	print_part(&scsi_dev_desc[dev]);
	366	}
	367	}
	368	if (!ok)
	369	printf("\nno SCSI devices available\n");
	370	return 1;
	371	}
	372	printf ("Usage:\n%s\n", cmdtp->usage);
	373	return 1;
	374	case 3:
	375	if (strncmp(argv[1],"dev",3) == 0) {
	376	int dev = (int)simple_strtoul(argv[2], NULL, 10);
	377	printf ("\nSCSI device %d: ", dev);
	378	if (dev >= CFG_SCSI_MAX_DEVICE) {
	379	printf("unknown device\n");
	380	return 1;
	381	}
	382	printf ("\n Device %d: ", dev);
	383	dev_print(&scsi_dev_desc[dev]);
	384	if(scsi_dev_desc[dev].type == DEV_TYPE_UNKNOWN) {
	385	return 1;
	386	}
	387	scsi_curr_dev = dev;
	388	printf("... is now current device\n");
	389	return 0;
	390	}
	391	if (strncmp(argv[1],"part",4) == 0) {
	392	int dev = (int)simple_strtoul(argv[2], NULL, 10);
	393	if(scsi_dev_desc[dev].type != DEV_TYPE_UNKNOWN) {
	394	print_part(&scsi_dev_desc[dev]);
	395	}
	396	else {
	397	printf ("\nSCSI device %d not available\n", dev);
	398	}
	399	return 1;
	400	}
	401	printf ("Usage:\n%s\n", cmdtp->usage);
	402	return 1;
	403	default:
	404	/* at least 4 args */
	405	if (strcmp(argv[1],"read") == 0) {
	406	ulong addr = simple_strtoul(argv[2], NULL, 16);
	407	ulong blk = simple_strtoul(argv[3], NULL, 16);
	408	ulong cnt = simple_strtoul(argv[4], NULL, 16);
	409	ulong n;
	410	printf ("\nSCSI read: device %d block # %ld, count %ld ... ",
	411	scsi_curr_dev, blk, cnt);
	412	n = scsi_read(scsi_curr_dev, blk, cnt, (ulong *)addr);
	413	printf ("%ld blocks read: %s\n",n,(n==cnt) ? "OK" : "ERROR");
	414	return 0;
	415	}
	416	} /* switch */
	417	printf ("Usage:\n%s\n", cmdtp->usage);
	418	return 1;
	419	}
	420
	421	/****************************************************************************************
	422	* scsi_read
	423	*/
	424
	425	#define SCSI_MAX_READ_BLK 0xFFFF /* almost the maximum amount of the scsi_ext command.. */
	426
eb867a76	427	ulong scsi_read(int device, ulong blknr, ulong blkcnt, void *buffer)
e887afc9 WD	428	{
	429	ulong start,blks, buf_addr;
	430	unsigned short smallblks;
	431	ccb* pccb=(ccb *)&tempccb;
	432	device&=0xff;
	433	/* Setup device
	434	*/
	435	pccb->target=scsi_dev_desc[device].target;
	436	pccb->lun=scsi_dev_desc[device].lun;
	437	buf_addr=(unsigned long)buffer;
	438	start=blknr;
	439	blks=blkcnt;
1a344f29	440	debug ("\nscsi_read: dev %d startblk %lx, blccnt %lx buffer %lx\n",device,start,blks,(unsigned long)buffer);
e887afc9 WD	441	do {
	442	pccb->pdata=(unsigned char *)buf_addr;
	443	if(blks>SCSI_MAX_READ_BLK) {
	444	pccb->datalen=scsi_dev_desc[device].blksz * SCSI_MAX_READ_BLK;
	445	smallblks=SCSI_MAX_READ_BLK;
	446	scsi_setup_read_ext(pccb,start,smallblks);
	447	start+=SCSI_MAX_READ_BLK;
	448	blks-=SCSI_MAX_READ_BLK;
	449	}
	450	else {
	451	pccb->datalen=scsi_dev_desc[device].blksz * blks;
	452	smallblks=(unsigned short) blks;
	453	scsi_setup_read_ext(pccb,start,smallblks);
	454	start+=blks;
	455	blks=0;
	456	}
1a344f29	457	debug ("scsi_read_ext: startblk %lx, blccnt %x buffer %lx\n",start,smallblks,buf_addr);
e887afc9 WD	458	if(scsi_exec(pccb)!=TRUE) {
	459	scsi_print_error(pccb);
	460	blkcnt-=blks;
	461	break;
	462	}
	463	buf_addr+=pccb->datalen;
	464	} while(blks!=0);
1a344f29	465	debug ("scsi_read_ext: end startblk %lx, blccnt %x buffer %lx\n",start,smallblks,buf_addr);
e887afc9 WD	466	return(blkcnt);
	467	}
	468
	469	/* copy src to dest, skipping leading and trailing blanks
	470	* and null terminate the string
	471	*/
	472	void scsi_ident_cpy (unsigned char dest, unsigned char src, unsigned int len)
	473	{
	474	int start,end;
	475
	476	start=0;
	477	while(start<len) {
	478	if(src[start]!=' ')
	479	break;
	480	start++;
	481	}
	482	end=len-1;
	483	while(end>start) {
	484	if(src[end]!=' ')
	485	break;
	486	end--;
	487	}
	488	for( ; start<=end; start++) {
	489	*dest++=src[start];
	490	}
	491	*dest='\0';
	492	}
	493
	494
e887afc9 WD	495	/* Trim trailing blanks, and NUL-terminate string
	496	*/
	497	void scsi_trim_trail (unsigned char *str, unsigned int len)
	498	{
	499	unsigned char *p = str + len - 1;
	500
	501	while (len-- > 0) {
	502	*p-- = '\0';
	503	if (*p != ' ') {
	504	return;
	505	}
	506	}
	507	}
	508
	509
	510	/************************************************************************************
	511	* Some setup (fill-in) routines
	512	*/
	513	void scsi_setup_test_unit_ready(ccb * pccb)
	514	{
	515	pccb->cmd[0]=SCSI_TST_U_RDY;
	516	pccb->cmd[1]=pccb->lun<<5;
	517	pccb->cmd[2]=0;
	518	pccb->cmd[3]=0;
	519	pccb->cmd[4]=0;
	520	pccb->cmd[5]=0;
	521	pccb->cmdlen=6;
	522	pccb->msgout[0]=SCSI_IDENTIFY; /* NOT USED */
	523	}
	524
	525	void scsi_setup_read_capacity(ccb * pccb)
	526	{
	527	pccb->cmd[0]=SCSI_RD_CAPAC;
	528	pccb->cmd[1]=pccb->lun<<5;
	529	pccb->cmd[2]=0;
	530	pccb->cmd[3]=0;
	531	pccb->cmd[4]=0;
	532	pccb->cmd[5]=0;
	533	pccb->cmd[6]=0;
	534	pccb->cmd[7]=0;
	535	pccb->cmd[8]=0;
	536	pccb->cmd[9]=0;
	537	pccb->cmdlen=10;
	538	pccb->msgout[0]=SCSI_IDENTIFY; /* NOT USED */
	539
	540	}
	541
	542	void scsi_setup_read_ext(ccb * pccb, unsigned long start, unsigned short blocks)
	543	{
	544	pccb->cmd[0]=SCSI_READ10;
	545	pccb->cmd[1]=pccb->lun<<5;
	546	pccb->cmd[2]=((unsigned char) (start>>24))&0xff;
	547	pccb->cmd[3]=((unsigned char) (start>>16))&0xff;
	548	pccb->cmd[4]=((unsigned char) (start>>8))&0xff;
	549	pccb->cmd[5]=((unsigned char) (start))&0xff;
	550	pccb->cmd[6]=0;
	551	pccb->cmd[7]=((unsigned char) (blocks>>8))&0xff;
	552	pccb->cmd[8]=(unsigned char) blocks & 0xff;
	553	pccb->cmd[6]=0;
	554	pccb->cmdlen=10;
	555	pccb->msgout[0]=SCSI_IDENTIFY; /* NOT USED */
1a344f29	556	debug ("scsi_setup_read_ext: cmd: %02X %02X startblk %02X%02X%02X%02X blccnt %02X%02X\n",
e887afc9 WD	557	pccb->cmd[0],pccb->cmd[1],
	558	pccb->cmd[2],pccb->cmd[3],pccb->cmd[4],pccb->cmd[5],
	559	pccb->cmd[7],pccb->cmd[8]);
	560	}
	561
	562	void scsi_setup_read6(ccb * pccb, unsigned long start, unsigned short blocks)
	563	{
	564	pccb->cmd[0]=SCSI_READ6;
	565	pccb->cmd[1]=pccb->lun<<5 \| (((unsigned char)(start>>16))&0x1f);
	566	pccb->cmd[2]=((unsigned char) (start>>8))&0xff;
	567	pccb->cmd[3]=((unsigned char) (start))&0xff;
	568	pccb->cmd[4]=(unsigned char) blocks & 0xff;
	569	pccb->cmd[5]=0;
	570	pccb->cmdlen=6;
	571	pccb->msgout[0]=SCSI_IDENTIFY; /* NOT USED */
1a344f29	572	debug ("scsi_setup_read6: cmd: %02X %02X startblk %02X%02X blccnt %02X\n",
e887afc9 WD	573	pccb->cmd[0],pccb->cmd[1],
	574	pccb->cmd[2],pccb->cmd[3],pccb->cmd[4]);
	575	}
	576
	577
	578	void scsi_setup_inquiry(ccb * pccb)
	579	{
	580	pccb->cmd[0]=SCSI_INQUIRY;
	581	pccb->cmd[1]=pccb->lun<<5;
	582	pccb->cmd[2]=0;
	583	pccb->cmd[3]=0;
	584	if(pccb->datalen>255)
	585	pccb->cmd[4]=255;
	586	else
	587	pccb->cmd[4]=(unsigned char)pccb->datalen;
	588	pccb->cmd[5]=0;
	589	pccb->cmdlen=6;
	590	pccb->msgout[0]=SCSI_IDENTIFY; /* NOT USED */
	591	}
	592
460c322f WD	593
	594	U_BOOT_CMD(
	595	scsi, 5, 1, do_scsi,
	596	"scsi - SCSI sub-system\n",
	597	"reset - reset SCSI controller\n"
	598	"scsi info - show available SCSI devices\n"
	599	"scsi scan - (re-)scan SCSI bus\n"
	600	"scsi device [dev] - show or set current device\n"
	601	"scsi part [dev] - print partition table of one or all SCSI devices\n"
	602	"scsi read addr blk# cnt - read `cnt' blocks starting at block `blk#'\n"
	603	" to memory address `addr'\n"
	604	);
	605
	606	U_BOOT_CMD(
	607	scsiboot, 3, 1, do_scsiboot,
	608	"scsiboot- boot from SCSI device\n",
	609	"loadAddr dev:part\n"
	610	);
	611
e887afc9	612	#endif /* #if (CONFIG_COMMANDS & CFG_CMD_SCSI) */