3 * Denis Peter, MPL AG Switzerland
5 * SPDX-License-Identifier: GPL-2.0+
14 #include <asm/processor.h>
19 #ifdef CONFIG_SCSI_DEV_LIST
20 #define SCSI_DEV_LIST CONFIG_SCSI_DEV_LIST
22 #ifdef CONFIG_SCSI_SYM53C8XX
23 #define SCSI_VEND_ID 0x1000
24 #ifndef CONFIG_SCSI_DEV_ID
25 #define SCSI_DEV_ID 0x0001
27 #define SCSI_DEV_ID CONFIG_SCSI_DEV_ID
29 #elif defined CONFIG_SATA_ULI5288
31 #define SCSI_VEND_ID 0x10b9
32 #define SCSI_DEV_ID 0x5288
34 #elif !defined(CONFIG_SCSI_AHCI_PLAT)
35 #error no scsi device defined
37 #define SCSI_DEV_LIST {SCSI_VEND_ID, SCSI_DEV_ID}
41 const struct pci_device_id scsi_device_list
[] = { SCSI_DEV_LIST
};
43 static ccb tempccb
; /* temporary scsi command buffer */
45 static unsigned char tempbuff
[512]; /* temporary data buffer */
47 static int scsi_max_devs
; /* number of highest available scsi device */
49 static int scsi_curr_dev
; /* current device */
51 static block_dev_desc_t scsi_dev_desc
[CONFIG_SYS_SCSI_MAX_DEVICE
];
53 /********************************************************************************
54 * forward declerations of some Setup Routines
56 void scsi_setup_test_unit_ready(ccb
* pccb
);
57 void scsi_setup_read6(ccb
* pccb
, unsigned long start
, unsigned short blocks
);
58 void scsi_setup_read_ext(ccb
* pccb
, unsigned long start
, unsigned short blocks
);
59 static void scsi_setup_write_ext(ccb
*pccb
, unsigned long start
,
60 unsigned short blocks
);
61 void scsi_setup_inquiry(ccb
* pccb
);
62 void scsi_ident_cpy (unsigned char *dest
, unsigned char *src
, unsigned int len
);
65 static int scsi_read_capacity(ccb
*pccb
, lbaint_t
*capacity
,
66 unsigned long *blksz
);
67 static ulong
scsi_read(int device
, lbaint_t blknr
, lbaint_t blkcnt
,
69 static ulong
scsi_write(int device
, lbaint_t blknr
,
70 lbaint_t blkcnt
, const void *buffer
);
73 /*********************************************************************************
74 * (re)-scan the scsi bus and reports scsi device info
75 * to the user if mode = 1
77 void scsi_scan(int mode
)
79 unsigned char i
,perq
,modi
,lun
;
82 ccb
* pccb
=(ccb
*)&tempccb
;
85 printf("scanning bus for devices...\n");
87 for(i
=0;i
<CONFIG_SYS_SCSI_MAX_DEVICE
;i
++) {
88 scsi_dev_desc
[i
].target
=0xff;
89 scsi_dev_desc
[i
].lun
=0xff;
90 scsi_dev_desc
[i
].lba
=0;
91 scsi_dev_desc
[i
].blksz
=0;
92 scsi_dev_desc
[i
].log2blksz
=
93 LOG2_INVALID(typeof(scsi_dev_desc
[i
].log2blksz
));
94 scsi_dev_desc
[i
].type
=DEV_TYPE_UNKNOWN
;
95 scsi_dev_desc
[i
].vendor
[0]=0;
96 scsi_dev_desc
[i
].product
[0]=0;
97 scsi_dev_desc
[i
].revision
[0]=0;
98 scsi_dev_desc
[i
].removable
= false;
99 scsi_dev_desc
[i
].if_type
=IF_TYPE_SCSI
;
100 scsi_dev_desc
[i
].dev
=i
;
101 scsi_dev_desc
[i
].part_type
=PART_TYPE_UNKNOWN
;
102 scsi_dev_desc
[i
].block_read
=scsi_read
;
103 scsi_dev_desc
[i
].block_write
= scsi_write
;
106 for(i
=0;i
<CONFIG_SYS_SCSI_MAX_SCSI_ID
;i
++) {
108 for(lun
=0;lun
<CONFIG_SYS_SCSI_MAX_LUN
;lun
++) {
110 pccb
->pdata
=(unsigned char *)&tempbuff
;
112 scsi_setup_inquiry(pccb
);
113 if (scsi_exec(pccb
) != true) {
114 if(pccb
->contr_stat
==SCSI_SEL_TIME_OUT
) {
115 debug ("Selection timeout ID %d\n",pccb
->target
);
116 continue; /* selection timeout => assuming no device present */
118 scsi_print_error(pccb
);
123 if((perq
& 0x1f)==0x1f) {
124 continue; /* skip unknown devices */
126 if((modi
&0x80)==0x80) /* drive is removable */
127 scsi_dev_desc
[scsi_max_devs
].removable
=true;
128 /* get info for this device */
129 scsi_ident_cpy((unsigned char *)&scsi_dev_desc
[scsi_max_devs
].vendor
[0],
131 scsi_ident_cpy((unsigned char *)&scsi_dev_desc
[scsi_max_devs
].product
[0],
133 scsi_ident_cpy((unsigned char *)&scsi_dev_desc
[scsi_max_devs
].revision
[0],
135 scsi_dev_desc
[scsi_max_devs
].target
=pccb
->target
;
136 scsi_dev_desc
[scsi_max_devs
].lun
=pccb
->lun
;
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
;
145 scsi_print_error(pccb
);
148 if (scsi_read_capacity(pccb
, &capacity
, &blksz
)) {
149 scsi_print_error(pccb
);
152 scsi_dev_desc
[scsi_max_devs
].lba
=capacity
;
153 scsi_dev_desc
[scsi_max_devs
].blksz
=blksz
;
154 scsi_dev_desc
[scsi_max_devs
].log2blksz
=
155 LOG2(scsi_dev_desc
[scsi_max_devs
].blksz
);
156 scsi_dev_desc
[scsi_max_devs
].type
=perq
;
157 init_part(&scsi_dev_desc
[scsi_max_devs
]);
160 printf (" Device %d: ", scsi_max_devs
);
161 dev_print(&scsi_dev_desc
[scsi_max_devs
]);
171 printf("Found %d device(s).\n", scsi_max_devs
);
172 #ifndef CONFIG_SPL_BUILD
173 setenv_ulong("scsidevs", scsi_max_devs
);
177 int scsi_get_disk_count(void)
179 return scsi_max_devs
;
188 * Find a device from the list, this driver will support a single
191 for (i
= 0; i
< ARRAY_SIZE(scsi_device_list
); i
++) {
192 /* get PCI Device ID */
193 busdevfunc
= pci_find_device(scsi_device_list
[i
].vendor
,
194 scsi_device_list
[i
].device
,
196 if (busdevfunc
!= -1)
200 if (busdevfunc
== -1) {
201 printf("Error: SCSI Controller(s) ");
202 for (i
= 0; i
< ARRAY_SIZE(scsi_device_list
); i
++) {
204 scsi_device_list
[i
].vendor
,
205 scsi_device_list
[i
].device
);
207 printf("not found\n");
212 printf("SCSI Controller (%04X,%04X) found (%d:%d:%d)\n",
213 scsi_device_list
[i
].vendor
,
214 scsi_device_list
[i
].device
,
215 (busdevfunc
>> 16) & 0xFF,
216 (busdevfunc
>> 11) & 0x1F,
217 (busdevfunc
>> 8) & 0x7);
220 bootstage_start(BOOTSTAGE_ID_ACCUM_SCSI
, "ahci");
221 scsi_low_level_init(busdevfunc
);
223 bootstage_accum(BOOTSTAGE_ID_ACCUM_SCSI
);
227 #ifdef CONFIG_PARTITIONS
228 block_dev_desc_t
* scsi_get_dev(int dev
)
230 return (dev
< CONFIG_SYS_SCSI_MAX_DEVICE
) ? &scsi_dev_desc
[dev
] : NULL
;
234 /******************************************************************************
235 * scsi boot command intepreter. Derived from diskboot
237 int do_scsiboot (cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
239 return common_diskboot(cmdtp
, "scsi", argc
, argv
);
242 /*********************************************************************************
243 * scsi command intepreter
245 int do_scsi (cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
250 return CMD_RET_USAGE
;
253 if (strncmp(argv
[1],"res",3) == 0) {
254 printf("\nReset SCSI\n");
259 if (strncmp(argv
[1],"inf",3) == 0) {
261 for (i
=0; i
<CONFIG_SYS_SCSI_MAX_DEVICE
; ++i
) {
262 if(scsi_dev_desc
[i
].type
==DEV_TYPE_UNKNOWN
)
263 continue; /* list only known devices */
264 printf ("SCSI dev. %d: ", i
);
265 dev_print(&scsi_dev_desc
[i
]);
269 if (strncmp(argv
[1],"dev",3) == 0) {
270 if ((scsi_curr_dev
< 0) || (scsi_curr_dev
>= CONFIG_SYS_SCSI_MAX_DEVICE
)) {
271 printf("\nno SCSI devices available\n");
274 printf ("\n Device %d: ", scsi_curr_dev
);
275 dev_print(&scsi_dev_desc
[scsi_curr_dev
]);
278 if (strncmp(argv
[1],"scan",4) == 0) {
282 if (strncmp(argv
[1],"part",4) == 0) {
284 for (ok
=0, dev
=0; dev
<CONFIG_SYS_SCSI_MAX_DEVICE
; ++dev
) {
285 if (scsi_dev_desc
[dev
].type
!=DEV_TYPE_UNKNOWN
) {
289 debug ("print_part of %x\n",dev
);
290 print_part(&scsi_dev_desc
[dev
]);
294 printf("\nno SCSI devices available\n");
297 return CMD_RET_USAGE
;
299 if (strncmp(argv
[1],"dev",3) == 0) {
300 int dev
= (int)simple_strtoul(argv
[2], NULL
, 10);
301 printf ("\nSCSI device %d: ", dev
);
302 if (dev
>= CONFIG_SYS_SCSI_MAX_DEVICE
) {
303 printf("unknown device\n");
306 printf ("\n Device %d: ", dev
);
307 dev_print(&scsi_dev_desc
[dev
]);
308 if(scsi_dev_desc
[dev
].type
== DEV_TYPE_UNKNOWN
) {
312 printf("... is now current device\n");
315 if (strncmp(argv
[1],"part",4) == 0) {
316 int dev
= (int)simple_strtoul(argv
[2], NULL
, 10);
317 if(scsi_dev_desc
[dev
].type
!= DEV_TYPE_UNKNOWN
) {
318 print_part(&scsi_dev_desc
[dev
]);
321 printf ("\nSCSI device %d not available\n", dev
);
325 return CMD_RET_USAGE
;
327 /* at least 4 args */
328 if (strcmp(argv
[1],"read") == 0) {
329 ulong addr
= simple_strtoul(argv
[2], NULL
, 16);
330 ulong blk
= simple_strtoul(argv
[3], NULL
, 16);
331 ulong cnt
= simple_strtoul(argv
[4], NULL
, 16);
333 printf ("\nSCSI read: device %d block # %ld, count %ld ... ",
334 scsi_curr_dev
, blk
, cnt
);
335 n
= scsi_read(scsi_curr_dev
, blk
, cnt
, (ulong
*)addr
);
336 printf ("%ld blocks read: %s\n",n
,(n
==cnt
) ? "OK" : "ERROR");
338 } else if (strcmp(argv
[1], "write") == 0) {
339 ulong addr
= simple_strtoul(argv
[2], NULL
, 16);
340 ulong blk
= simple_strtoul(argv
[3], NULL
, 16);
341 ulong cnt
= simple_strtoul(argv
[4], NULL
, 16);
343 printf("\nSCSI write: device %d block # %ld, "
345 scsi_curr_dev
, blk
, cnt
);
346 n
= scsi_write(scsi_curr_dev
, blk
, cnt
,
348 printf("%ld blocks written: %s\n", n
,
349 (n
== cnt
) ? "OK" : "ERROR");
353 return CMD_RET_USAGE
;
356 /****************************************************************************************
360 #define SCSI_MAX_READ_BLK 0xFFFF /* almost the maximum amount of the scsi_ext command.. */
362 static ulong
scsi_read(int device
, lbaint_t blknr
, lbaint_t blkcnt
,
365 lbaint_t start
, blks
;
367 unsigned short smallblks
;
368 ccb
* pccb
=(ccb
*)&tempccb
;
372 pccb
->target
=scsi_dev_desc
[device
].target
;
373 pccb
->lun
=scsi_dev_desc
[device
].lun
;
374 buf_addr
=(unsigned long)buffer
;
377 debug("\nscsi_read: dev %d startblk " LBAF
378 ", blccnt " LBAF
" buffer %lx\n",
379 device
, start
, blks
, (unsigned long)buffer
);
381 pccb
->pdata
=(unsigned char *)buf_addr
;
382 if(blks
>SCSI_MAX_READ_BLK
) {
383 pccb
->datalen
=scsi_dev_desc
[device
].blksz
* SCSI_MAX_READ_BLK
;
384 smallblks
=SCSI_MAX_READ_BLK
;
385 scsi_setup_read_ext(pccb
,start
,smallblks
);
386 start
+=SCSI_MAX_READ_BLK
;
387 blks
-=SCSI_MAX_READ_BLK
;
390 pccb
->datalen
=scsi_dev_desc
[device
].blksz
* blks
;
391 smallblks
=(unsigned short) blks
;
392 scsi_setup_read_ext(pccb
,start
,smallblks
);
396 debug("scsi_read_ext: startblk " LBAF
397 ", blccnt %x buffer %" PRIXPTR
"\n",
398 start
, smallblks
, buf_addr
);
399 if (scsi_exec(pccb
) != true) {
400 scsi_print_error(pccb
);
404 buf_addr
+=pccb
->datalen
;
406 debug("scsi_read_ext: end startblk " LBAF
407 ", blccnt %x buffer %" PRIXPTR
"\n", start
, smallblks
, buf_addr
);
411 /*******************************************************************************
415 /* Almost the maximum amount of the scsi_ext command.. */
416 #define SCSI_MAX_WRITE_BLK 0xFFFF
418 static ulong
scsi_write(int device
, lbaint_t blknr
,
419 lbaint_t blkcnt
, const void *buffer
)
421 lbaint_t start
, blks
;
423 unsigned short smallblks
;
424 ccb
* pccb
= (ccb
*)&tempccb
;
428 pccb
->target
= scsi_dev_desc
[device
].target
;
429 pccb
->lun
= scsi_dev_desc
[device
].lun
;
430 buf_addr
= (unsigned long)buffer
;
433 debug("\n%s: dev %d startblk " LBAF
", blccnt " LBAF
" buffer %lx\n",
434 __func__
, device
, start
, blks
, (unsigned long)buffer
);
436 pccb
->pdata
= (unsigned char *)buf_addr
;
437 if (blks
> SCSI_MAX_WRITE_BLK
) {
438 pccb
->datalen
= (scsi_dev_desc
[device
].blksz
*
440 smallblks
= SCSI_MAX_WRITE_BLK
;
441 scsi_setup_write_ext(pccb
, start
, smallblks
);
442 start
+= SCSI_MAX_WRITE_BLK
;
443 blks
-= SCSI_MAX_WRITE_BLK
;
445 pccb
->datalen
= scsi_dev_desc
[device
].blksz
* blks
;
446 smallblks
= (unsigned short)blks
;
447 scsi_setup_write_ext(pccb
, start
, smallblks
);
451 debug("%s: startblk " LBAF
", blccnt %x buffer %" PRIXPTR
"\n",
452 __func__
, start
, smallblks
, buf_addr
);
453 if (scsi_exec(pccb
) != true) {
454 scsi_print_error(pccb
);
458 buf_addr
+= pccb
->datalen
;
460 debug("%s: end startblk " LBAF
", blccnt %x buffer %" PRIXPTR
"\n",
461 __func__
, start
, smallblks
, buf_addr
);
465 /* copy src to dest, skipping leading and trailing blanks
466 * and null terminate the string
468 void scsi_ident_cpy (unsigned char *dest
, unsigned char *src
, unsigned int len
)
484 for( ; start
<=end
; start
++) {
491 /* Trim trailing blanks, and NUL-terminate string
493 void scsi_trim_trail (unsigned char *str
, unsigned int len
)
495 unsigned char *p
= str
+ len
- 1;
505 int scsi_read_capacity(ccb
*pccb
, lbaint_t
*capacity
, unsigned long *blksz
)
509 memset(pccb
->cmd
, 0, sizeof(pccb
->cmd
));
510 pccb
->cmd
[0] = SCSI_RD_CAPAC10
;
511 pccb
->cmd
[1] = pccb
->lun
<< 5;
513 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
516 if (scsi_exec(pccb
) != true)
519 *capacity
= ((lbaint_t
)pccb
->pdata
[0] << 24) |
520 ((lbaint_t
)pccb
->pdata
[1] << 16) |
521 ((lbaint_t
)pccb
->pdata
[2] << 8) |
522 ((lbaint_t
)pccb
->pdata
[3]);
524 if (*capacity
!= 0xffffffff) {
525 /* Read capacity (10) was sufficient for this drive. */
526 *blksz
= ((unsigned long)pccb
->pdata
[4] << 24) |
527 ((unsigned long)pccb
->pdata
[5] << 16) |
528 ((unsigned long)pccb
->pdata
[6] << 8) |
529 ((unsigned long)pccb
->pdata
[7]);
533 /* Read capacity (10) was insufficient. Use read capacity (16). */
535 memset(pccb
->cmd
, 0, sizeof(pccb
->cmd
));
536 pccb
->cmd
[0] = SCSI_RD_CAPAC16
;
539 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
542 if (scsi_exec(pccb
) != true)
545 *capacity
= ((uint64_t)pccb
->pdata
[0] << 56) |
546 ((uint64_t)pccb
->pdata
[1] << 48) |
547 ((uint64_t)pccb
->pdata
[2] << 40) |
548 ((uint64_t)pccb
->pdata
[3] << 32) |
549 ((uint64_t)pccb
->pdata
[4] << 24) |
550 ((uint64_t)pccb
->pdata
[5] << 16) |
551 ((uint64_t)pccb
->pdata
[6] << 8) |
552 ((uint64_t)pccb
->pdata
[7]);
554 *blksz
= ((uint64_t)pccb
->pdata
[8] << 56) |
555 ((uint64_t)pccb
->pdata
[9] << 48) |
556 ((uint64_t)pccb
->pdata
[10] << 40) |
557 ((uint64_t)pccb
->pdata
[11] << 32) |
558 ((uint64_t)pccb
->pdata
[12] << 24) |
559 ((uint64_t)pccb
->pdata
[13] << 16) |
560 ((uint64_t)pccb
->pdata
[14] << 8) |
561 ((uint64_t)pccb
->pdata
[15]);
567 /************************************************************************************
568 * Some setup (fill-in) routines
570 void scsi_setup_test_unit_ready(ccb
* pccb
)
572 pccb
->cmd
[0]=SCSI_TST_U_RDY
;
573 pccb
->cmd
[1]=pccb
->lun
<<5;
579 pccb
->msgout
[0]=SCSI_IDENTIFY
; /* NOT USED */
582 void scsi_setup_read_ext(ccb
* pccb
, unsigned long start
, unsigned short blocks
)
584 pccb
->cmd
[0]=SCSI_READ10
;
585 pccb
->cmd
[1]=pccb
->lun
<<5;
586 pccb
->cmd
[2]=((unsigned char) (start
>>24))&0xff;
587 pccb
->cmd
[3]=((unsigned char) (start
>>16))&0xff;
588 pccb
->cmd
[4]=((unsigned char) (start
>>8))&0xff;
589 pccb
->cmd
[5]=((unsigned char) (start
))&0xff;
591 pccb
->cmd
[7]=((unsigned char) (blocks
>>8))&0xff;
592 pccb
->cmd
[8]=(unsigned char) blocks
& 0xff;
595 pccb
->msgout
[0]=SCSI_IDENTIFY
; /* NOT USED */
596 debug ("scsi_setup_read_ext: cmd: %02X %02X startblk %02X%02X%02X%02X blccnt %02X%02X\n",
597 pccb
->cmd
[0],pccb
->cmd
[1],
598 pccb
->cmd
[2],pccb
->cmd
[3],pccb
->cmd
[4],pccb
->cmd
[5],
599 pccb
->cmd
[7],pccb
->cmd
[8]);
602 void scsi_setup_write_ext(ccb
*pccb
, unsigned long start
, unsigned short blocks
)
604 pccb
->cmd
[0] = SCSI_WRITE10
;
605 pccb
->cmd
[1] = pccb
->lun
<< 5;
606 pccb
->cmd
[2] = ((unsigned char) (start
>>24)) & 0xff;
607 pccb
->cmd
[3] = ((unsigned char) (start
>>16)) & 0xff;
608 pccb
->cmd
[4] = ((unsigned char) (start
>>8)) & 0xff;
609 pccb
->cmd
[5] = ((unsigned char) (start
)) & 0xff;
611 pccb
->cmd
[7] = ((unsigned char) (blocks
>>8)) & 0xff;
612 pccb
->cmd
[8] = (unsigned char)blocks
& 0xff;
615 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
616 debug("%s: cmd: %02X %02X startblk %02X%02X%02X%02X blccnt %02X%02X\n",
618 pccb
->cmd
[0], pccb
->cmd
[1],
619 pccb
->cmd
[2], pccb
->cmd
[3], pccb
->cmd
[4], pccb
->cmd
[5],
620 pccb
->cmd
[7], pccb
->cmd
[8]);
623 void scsi_setup_read6(ccb
* pccb
, unsigned long start
, unsigned short blocks
)
625 pccb
->cmd
[0]=SCSI_READ6
;
626 pccb
->cmd
[1]=pccb
->lun
<<5 | (((unsigned char)(start
>>16))&0x1f);
627 pccb
->cmd
[2]=((unsigned char) (start
>>8))&0xff;
628 pccb
->cmd
[3]=((unsigned char) (start
))&0xff;
629 pccb
->cmd
[4]=(unsigned char) blocks
& 0xff;
632 pccb
->msgout
[0]=SCSI_IDENTIFY
; /* NOT USED */
633 debug ("scsi_setup_read6: cmd: %02X %02X startblk %02X%02X blccnt %02X\n",
634 pccb
->cmd
[0],pccb
->cmd
[1],
635 pccb
->cmd
[2],pccb
->cmd
[3],pccb
->cmd
[4]);
639 void scsi_setup_inquiry(ccb
* pccb
)
641 pccb
->cmd
[0]=SCSI_INQUIRY
;
642 pccb
->cmd
[1]=pccb
->lun
<<5;
645 if(pccb
->datalen
>255)
648 pccb
->cmd
[4]=(unsigned char)pccb
->datalen
;
651 pccb
->msgout
[0]=SCSI_IDENTIFY
; /* NOT USED */
658 "reset - reset SCSI controller\n"
659 "scsi info - show available SCSI devices\n"
660 "scsi scan - (re-)scan SCSI bus\n"
661 "scsi device [dev] - show or set current device\n"
662 "scsi part [dev] - print partition table of one or all SCSI devices\n"
663 "scsi read addr blk# cnt - read `cnt' blocks starting at block `blk#'\n"
664 " to memory address `addr'\n"
665 "scsi write addr blk# cnt - write `cnt' blocks starting at block\n"
666 " `blk#' from memory address `addr'"
670 scsiboot
, 3, 1, do_scsiboot
,
671 "boot from SCSI device",