[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>

#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((unsigned char *)&scsi_dev_desc[scsi_max_devs].vendor[0],
				       &tempbuff[8], 8);
			scsi_ident_cpy((unsigned char *)&scsi_dev_desc[scsi_max_devs].product[0],
				       &tempbuff[16], 16);
			scsi_ident_cpy((unsigned char *)&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;
	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 (!image_check_magic (hdr)) {
		printf("\n** Bad Magic Number **\n");
		return 1;
	}

	if (!image_check_hcrc (hdr)) {
		puts ("\n** Bad Header Checksum **\n");
		return 1;
	}

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