3 * Denis Peter, MPL AG Switzerland
5 * See file CREDITS for list of people who contributed to this
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.
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.
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,
32 #include <asm/processor.h>
37 #if defined(CONFIG_CMD_SCSI)
39 #ifdef CONFIG_SCSI_SYM53C8XX
40 #define SCSI_VEND_ID 0x1000
41 #ifndef CONFIG_SCSI_DEV_ID
42 #define SCSI_DEV_ID 0x0001
44 #define SCSI_DEV_ID CONFIG_SCSI_DEV_ID
46 #elif defined CONFIG_SATA_ULI5288
48 #define SCSI_VEND_ID 0x10b9
49 #define SCSI_DEV_ID 0x5288
52 #error no scsi device defined
56 static ccb tempccb
; /* temporary scsi command buffer */
58 static unsigned char tempbuff
[512]; /* temporary data buffer */
60 static int scsi_max_devs
; /* number of highest available scsi device */
62 static int scsi_curr_dev
; /* current device */
64 static block_dev_desc_t scsi_dev_desc
[CFG_SCSI_MAX_DEVICE
];
66 /********************************************************************************
67 * forward declerations of some Setup Routines
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
);
77 ulong
scsi_read(int device
, ulong blknr
, ulong blkcnt
, void *buffer
);
80 /*********************************************************************************
81 * (re)-scan the scsi bus and reports scsi device info
82 * to the user if mode = 1
84 void scsi_scan(int mode
)
86 unsigned char i
,perq
,modi
,lun
;
87 unsigned long capacity
,blksz
;
88 ccb
* pccb
=(ccb
*)&tempccb
;
91 printf("scanning bus for devices...\n");
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
;
109 for(i
=0;i
<CFG_SCSI_MAX_SCSI_ID
;i
++) {
111 for(lun
=0;lun
<CFG_SCSI_MAX_LUN
;lun
++) {
113 pccb
->pdata
=(unsigned char *)&tempbuff
;
115 scsi_setup_inquiry(pccb
);
116 if(scsi_exec(pccb
)!=TRUE
) {
117 if(pccb
->contr_stat
==SCSI_SEL_TIME_OUT
) {
118 debug ("Selection timeout ID %d\n",pccb
->target
);
119 continue; /* selection timeout => assuming no device present */
121 scsi_print_error(pccb
);
126 if((perq
& 0x1f)==0x1f) {
127 continue; /* skip unknown devices */
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((unsigned char *)&scsi_dev_desc
[scsi_max_devs
].vendor
[0],
134 scsi_ident_cpy((unsigned char *)&scsi_dev_desc
[scsi_max_devs
].product
[0],
136 scsi_ident_cpy((unsigned char *)&scsi_dev_desc
[scsi_max_devs
].revision
[0],
138 scsi_dev_desc
[scsi_max_devs
].target
=pccb
->target
;
139 scsi_dev_desc
[scsi_max_devs
].lun
=pccb
->lun
;
142 scsi_setup_test_unit_ready(pccb
);
143 if(scsi_exec(pccb
)!=TRUE
) {
144 if(scsi_dev_desc
[scsi_max_devs
].removable
==TRUE
) {
145 scsi_dev_desc
[scsi_max_devs
].type
=perq
;
148 scsi_print_error(pccb
);
152 scsi_setup_read_capacity(pccb
);
153 if(scsi_exec(pccb
)!=TRUE
) {
154 scsi_print_error(pccb
);
157 capacity
=((unsigned long)tempbuff
[0]<<24)|((unsigned long)tempbuff
[1]<<16)|
158 ((unsigned long)tempbuff
[2]<<8)|((unsigned long)tempbuff
[3]);
159 blksz
=((unsigned long)tempbuff
[4]<<24)|((unsigned long)tempbuff
[5]<<16)|
160 ((unsigned long)tempbuff
[6]<<8)|((unsigned long)tempbuff
[7]);
161 scsi_dev_desc
[scsi_max_devs
].lba
=capacity
;
162 scsi_dev_desc
[scsi_max_devs
].blksz
=blksz
;
163 scsi_dev_desc
[scsi_max_devs
].type
=perq
;
164 init_part(&scsi_dev_desc
[scsi_max_devs
]);
167 printf (" Device %d: ", scsi_max_devs
);
168 dev_print(&scsi_dev_desc
[scsi_max_devs
]);
184 busdevfunc
=pci_find_device(SCSI_VEND_ID
,SCSI_DEV_ID
,0); /* get PCI Device ID */
186 printf("Error SCSI Controller (%04X,%04X) not found\n",SCSI_VEND_ID
,SCSI_DEV_ID
);
191 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);
194 scsi_low_level_init(busdevfunc
);
198 block_dev_desc_t
* scsi_get_dev(int dev
)
200 return (dev
< CFG_SCSI_MAX_DEVICE
) ? &scsi_dev_desc
[dev
] : NULL
;
204 /******************************************************************************
205 * scsi boot command intepreter. Derived from diskboot
207 int do_scsiboot (cmd_tbl_t
*cmdtp
, int flag
, int argc
, char *argv
[])
209 char *boot_device
= NULL
;
212 ulong addr
, cnt
, checksum
;
213 disk_partition_t info
;
219 addr
= CFG_LOAD_ADDR
;
220 boot_device
= getenv ("bootdevice");
223 addr
= simple_strtoul(argv
[1], NULL
, 16);
224 boot_device
= getenv ("bootdevice");
227 addr
= simple_strtoul(argv
[1], NULL
, 16);
228 boot_device
= argv
[2];
231 printf ("Usage:\n%s\n", cmdtp
->usage
);
236 puts ("\n** No boot device **\n");
240 dev
= simple_strtoul(boot_device
, &ep
, 16);
241 printf("booting from dev %d\n",dev
);
242 if (scsi_dev_desc
[dev
].type
== DEV_TYPE_UNKNOWN
) {
243 printf ("\n** Device %d not available\n", dev
);
249 puts ("\n** Invalid boot device, use `dev[:part]' **\n");
252 part
= simple_strtoul(++ep
, NULL
, 16);
254 if (get_partition_info (&scsi_dev_desc
[dev
], part
, &info
)) {
255 printf("error reading partinfo\n");
258 if ((strncmp((char *)(info
.type
), BOOT_PART_TYPE
, sizeof(info
.type
)) != 0) &&
259 (strncmp((char *)(info
.type
), BOOT_PART_COMP
, sizeof(info
.type
)) != 0)) {
260 printf ("\n** Invalid partition type \"%.32s\""
261 " (expect \"" BOOT_PART_TYPE
"\")\n",
266 printf ("\nLoading from SCSI device %d, partition %d: "
267 "Name: %.32s Type: %.32s\n",
268 dev
, part
, info
.name
, info
.type
);
270 debug ("First Block: %ld, # of blocks: %ld, Block Size: %ld\n",
271 info
.start
, info
.size
, info
.blksz
);
273 if (scsi_read (dev
, info
.start
, 1, (ulong
*)addr
) != 1) {
274 printf ("** Read error on %d:%d\n", dev
, part
);
278 hdr
= (image_header_t
*)addr
;
280 if (ntohl(hdr
->ih_magic
) == IH_MAGIC
) {
281 printf("\n** Bad Magic Number **\n");
285 checksum
= ntohl(hdr
->ih_hcrc
);
288 if (crc32 (0, (uchar
*)hdr
, sizeof(image_header_t
)) != checksum
) {
289 puts ("\n** Bad Header Checksum **\n");
292 hdr
->ih_hcrc
= htonl(checksum
); /* restore checksum for later use */
294 print_image_hdr (hdr
);
295 cnt
= (ntohl(hdr
->ih_size
) + sizeof(image_header_t
));
296 cnt
+= info
.blksz
- 1;
300 if (scsi_read (dev
, info
.start
+1, cnt
,
301 (ulong
*)(addr
+info
.blksz
)) != cnt
) {
302 printf ("** Read error on %d:%d\n", dev
, part
);
305 /* Loading ok, update default load address */
308 flush_cache (addr
, (cnt
+1)*info
.blksz
);
310 /* Check if we should attempt an auto-start */
311 if (((ep
= getenv("autostart")) != NULL
) && (strcmp(ep
,"yes") == 0)) {
313 extern int do_bootm (cmd_tbl_t
*, int, int, char *[]);
314 local_args
[0] = argv
[0];
315 local_args
[1] = NULL
;
316 printf ("Automatic boot of image at addr 0x%08lX ...\n", addr
);
317 rcode
= do_bootm (cmdtp
, 0, 1, local_args
);
322 /*********************************************************************************
323 * scsi command intepreter
325 int do_scsi (cmd_tbl_t
*cmdtp
, int flag
, int argc
, char *argv
[])
329 case 1: printf ("Usage:\n%s\n", cmdtp
->usage
); return 1;
331 if (strncmp(argv
[1],"res",3) == 0) {
332 printf("\nReset SCSI\n");
337 if (strncmp(argv
[1],"inf",3) == 0) {
339 for (i
=0; i
<CFG_SCSI_MAX_DEVICE
; ++i
) {
340 if(scsi_dev_desc
[i
].type
==DEV_TYPE_UNKNOWN
)
341 continue; /* list only known devices */
342 printf ("SCSI dev. %d: ", i
);
343 dev_print(&scsi_dev_desc
[i
]);
347 if (strncmp(argv
[1],"dev",3) == 0) {
348 if ((scsi_curr_dev
< 0) || (scsi_curr_dev
>= CFG_SCSI_MAX_DEVICE
)) {
349 printf("\nno SCSI devices available\n");
352 printf ("\n Device %d: ", scsi_curr_dev
);
353 dev_print(&scsi_dev_desc
[scsi_curr_dev
]);
356 if (strncmp(argv
[1],"scan",4) == 0) {
360 if (strncmp(argv
[1],"part",4) == 0) {
362 for (ok
=0, dev
=0; dev
<CFG_SCSI_MAX_DEVICE
; ++dev
) {
363 if (scsi_dev_desc
[dev
].type
!=DEV_TYPE_UNKNOWN
) {
367 debug ("print_part of %x\n",dev
);
368 print_part(&scsi_dev_desc
[dev
]);
372 printf("\nno SCSI devices available\n");
375 printf ("Usage:\n%s\n", cmdtp
->usage
);
378 if (strncmp(argv
[1],"dev",3) == 0) {
379 int dev
= (int)simple_strtoul(argv
[2], NULL
, 10);
380 printf ("\nSCSI device %d: ", dev
);
381 if (dev
>= CFG_SCSI_MAX_DEVICE
) {
382 printf("unknown device\n");
385 printf ("\n Device %d: ", dev
);
386 dev_print(&scsi_dev_desc
[dev
]);
387 if(scsi_dev_desc
[dev
].type
== DEV_TYPE_UNKNOWN
) {
391 printf("... is now current device\n");
394 if (strncmp(argv
[1],"part",4) == 0) {
395 int dev
= (int)simple_strtoul(argv
[2], NULL
, 10);
396 if(scsi_dev_desc
[dev
].type
!= DEV_TYPE_UNKNOWN
) {
397 print_part(&scsi_dev_desc
[dev
]);
400 printf ("\nSCSI device %d not available\n", dev
);
404 printf ("Usage:\n%s\n", cmdtp
->usage
);
407 /* at least 4 args */
408 if (strcmp(argv
[1],"read") == 0) {
409 ulong addr
= simple_strtoul(argv
[2], NULL
, 16);
410 ulong blk
= simple_strtoul(argv
[3], NULL
, 16);
411 ulong cnt
= simple_strtoul(argv
[4], NULL
, 16);
413 printf ("\nSCSI read: device %d block # %ld, count %ld ... ",
414 scsi_curr_dev
, blk
, cnt
);
415 n
= scsi_read(scsi_curr_dev
, blk
, cnt
, (ulong
*)addr
);
416 printf ("%ld blocks read: %s\n",n
,(n
==cnt
) ? "OK" : "ERROR");
420 printf ("Usage:\n%s\n", cmdtp
->usage
);
424 /****************************************************************************************
428 #define SCSI_MAX_READ_BLK 0xFFFF /* almost the maximum amount of the scsi_ext command.. */
430 ulong
scsi_read(int device
, ulong blknr
, ulong blkcnt
, void *buffer
)
432 ulong start
,blks
, buf_addr
;
433 unsigned short smallblks
;
434 ccb
* pccb
=(ccb
*)&tempccb
;
438 pccb
->target
=scsi_dev_desc
[device
].target
;
439 pccb
->lun
=scsi_dev_desc
[device
].lun
;
440 buf_addr
=(unsigned long)buffer
;
443 debug ("\nscsi_read: dev %d startblk %lx, blccnt %lx buffer %lx\n",device
,start
,blks
,(unsigned long)buffer
);
445 pccb
->pdata
=(unsigned char *)buf_addr
;
446 if(blks
>SCSI_MAX_READ_BLK
) {
447 pccb
->datalen
=scsi_dev_desc
[device
].blksz
* SCSI_MAX_READ_BLK
;
448 smallblks
=SCSI_MAX_READ_BLK
;
449 scsi_setup_read_ext(pccb
,start
,smallblks
);
450 start
+=SCSI_MAX_READ_BLK
;
451 blks
-=SCSI_MAX_READ_BLK
;
454 pccb
->datalen
=scsi_dev_desc
[device
].blksz
* blks
;
455 smallblks
=(unsigned short) blks
;
456 scsi_setup_read_ext(pccb
,start
,smallblks
);
460 debug ("scsi_read_ext: startblk %lx, blccnt %x buffer %lx\n",start
,smallblks
,buf_addr
);
461 if(scsi_exec(pccb
)!=TRUE
) {
462 scsi_print_error(pccb
);
466 buf_addr
+=pccb
->datalen
;
468 debug ("scsi_read_ext: end startblk %lx, blccnt %x buffer %lx\n",start
,smallblks
,buf_addr
);
472 /* copy src to dest, skipping leading and trailing blanks
473 * and null terminate the string
475 void scsi_ident_cpy (unsigned char *dest
, unsigned char *src
, unsigned int len
)
491 for( ; start
<=end
; start
++) {
498 /* Trim trailing blanks, and NUL-terminate string
500 void scsi_trim_trail (unsigned char *str
, unsigned int len
)
502 unsigned char *p
= str
+ len
- 1;
513 /************************************************************************************
514 * Some setup (fill-in) routines
516 void scsi_setup_test_unit_ready(ccb
* pccb
)
518 pccb
->cmd
[0]=SCSI_TST_U_RDY
;
519 pccb
->cmd
[1]=pccb
->lun
<<5;
525 pccb
->msgout
[0]=SCSI_IDENTIFY
; /* NOT USED */
528 void scsi_setup_read_capacity(ccb
* pccb
)
530 pccb
->cmd
[0]=SCSI_RD_CAPAC
;
531 pccb
->cmd
[1]=pccb
->lun
<<5;
541 pccb
->msgout
[0]=SCSI_IDENTIFY
; /* NOT USED */
545 void scsi_setup_read_ext(ccb
* pccb
, unsigned long start
, unsigned short blocks
)
547 pccb
->cmd
[0]=SCSI_READ10
;
548 pccb
->cmd
[1]=pccb
->lun
<<5;
549 pccb
->cmd
[2]=((unsigned char) (start
>>24))&0xff;
550 pccb
->cmd
[3]=((unsigned char) (start
>>16))&0xff;
551 pccb
->cmd
[4]=((unsigned char) (start
>>8))&0xff;
552 pccb
->cmd
[5]=((unsigned char) (start
))&0xff;
554 pccb
->cmd
[7]=((unsigned char) (blocks
>>8))&0xff;
555 pccb
->cmd
[8]=(unsigned char) blocks
& 0xff;
558 pccb
->msgout
[0]=SCSI_IDENTIFY
; /* NOT USED */
559 debug ("scsi_setup_read_ext: cmd: %02X %02X startblk %02X%02X%02X%02X blccnt %02X%02X\n",
560 pccb
->cmd
[0],pccb
->cmd
[1],
561 pccb
->cmd
[2],pccb
->cmd
[3],pccb
->cmd
[4],pccb
->cmd
[5],
562 pccb
->cmd
[7],pccb
->cmd
[8]);
565 void scsi_setup_read6(ccb
* pccb
, unsigned long start
, unsigned short blocks
)
567 pccb
->cmd
[0]=SCSI_READ6
;
568 pccb
->cmd
[1]=pccb
->lun
<<5 | (((unsigned char)(start
>>16))&0x1f);
569 pccb
->cmd
[2]=((unsigned char) (start
>>8))&0xff;
570 pccb
->cmd
[3]=((unsigned char) (start
))&0xff;
571 pccb
->cmd
[4]=(unsigned char) blocks
& 0xff;
574 pccb
->msgout
[0]=SCSI_IDENTIFY
; /* NOT USED */
575 debug ("scsi_setup_read6: cmd: %02X %02X startblk %02X%02X blccnt %02X\n",
576 pccb
->cmd
[0],pccb
->cmd
[1],
577 pccb
->cmd
[2],pccb
->cmd
[3],pccb
->cmd
[4]);
581 void scsi_setup_inquiry(ccb
* pccb
)
583 pccb
->cmd
[0]=SCSI_INQUIRY
;
584 pccb
->cmd
[1]=pccb
->lun
<<5;
587 if(pccb
->datalen
>255)
590 pccb
->cmd
[4]=(unsigned char)pccb
->datalen
;
593 pccb
->msgout
[0]=SCSI_IDENTIFY
; /* NOT USED */
599 "scsi - SCSI sub-system\n",
600 "reset - reset SCSI controller\n"
601 "scsi info - show available SCSI devices\n"
602 "scsi scan - (re-)scan SCSI bus\n"
603 "scsi device [dev] - show or set current device\n"
604 "scsi part [dev] - print partition table of one or all SCSI devices\n"
605 "scsi read addr blk# cnt - read `cnt' blocks starting at block `blk#'\n"
606 " to memory address `addr'\n"
610 scsiboot
, 3, 1, do_scsiboot
,
611 "scsiboot- boot from SCSI device\n",
612 "loadAddr dev:part\n"