3 * Denis Peter, MPL AG Switzerland
5 * SPDX-License-Identifier: GPL-2.0+
13 #ifdef CONFIG_SCSI_DEV_LIST
14 #define SCSI_DEV_LIST CONFIG_SCSI_DEV_LIST
16 #ifdef CONFIG_SCSI_SYM53C8XX
17 #define SCSI_VEND_ID 0x1000
18 #ifndef CONFIG_SCSI_DEV_ID
19 #define SCSI_DEV_ID 0x0001
21 #define SCSI_DEV_ID CONFIG_SCSI_DEV_ID
23 #elif defined CONFIG_SATA_ULI5288
25 #define SCSI_VEND_ID 0x10b9
26 #define SCSI_DEV_ID 0x5288
28 #elif !defined(CONFIG_SCSI_AHCI_PLAT)
29 #error no scsi device defined
31 #define SCSI_DEV_LIST {SCSI_VEND_ID, SCSI_DEV_ID}
34 #if defined(CONFIG_PCI) && !defined(CONFIG_SCSI_AHCI_PLAT)
35 const struct pci_device_id scsi_device_list
[] = { SCSI_DEV_LIST
};
37 static ccb tempccb
; /* temporary scsi command buffer */
39 static unsigned char tempbuff
[512]; /* temporary data buffer */
41 static int scsi_max_devs
; /* number of highest available scsi device */
43 static int scsi_curr_dev
; /* current device */
45 static struct blk_desc scsi_dev_desc
[CONFIG_SYS_SCSI_MAX_DEVICE
];
47 /* almost the maximum amount of the scsi_ext command.. */
48 #define SCSI_MAX_READ_BLK 0xFFFF
49 #define SCSI_LBA48_READ 0xFFFFFFF
51 #ifdef CONFIG_SYS_64BIT_LBA
52 void scsi_setup_read16(ccb
*pccb
, lbaint_t start
, unsigned long blocks
)
54 pccb
->cmd
[0] = SCSI_READ16
;
55 pccb
->cmd
[1] = pccb
->lun
<< 5;
56 pccb
->cmd
[2] = (unsigned char)(start
>> 56) & 0xff;
57 pccb
->cmd
[3] = (unsigned char)(start
>> 48) & 0xff;
58 pccb
->cmd
[4] = (unsigned char)(start
>> 40) & 0xff;
59 pccb
->cmd
[5] = (unsigned char)(start
>> 32) & 0xff;
60 pccb
->cmd
[6] = (unsigned char)(start
>> 24) & 0xff;
61 pccb
->cmd
[7] = (unsigned char)(start
>> 16) & 0xff;
62 pccb
->cmd
[8] = (unsigned char)(start
>> 8) & 0xff;
63 pccb
->cmd
[9] = (unsigned char)start
& 0xff;
65 pccb
->cmd
[11] = (unsigned char)(blocks
>> 24) & 0xff;
66 pccb
->cmd
[12] = (unsigned char)(blocks
>> 16) & 0xff;
67 pccb
->cmd
[13] = (unsigned char)(blocks
>> 8) & 0xff;
68 pccb
->cmd
[14] = (unsigned char)blocks
& 0xff;
71 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
72 debug("scsi_setup_read16: cmd: %02X %02X startblk %02X%02X%02X%02X%02X%02X%02X%02X blccnt %02X%02X%02X%02X\n",
73 pccb
->cmd
[0], pccb
->cmd
[1],
74 pccb
->cmd
[2], pccb
->cmd
[3], pccb
->cmd
[4], pccb
->cmd
[5],
75 pccb
->cmd
[6], pccb
->cmd
[7], pccb
->cmd
[8], pccb
->cmd
[9],
76 pccb
->cmd
[11], pccb
->cmd
[12], pccb
->cmd
[13], pccb
->cmd
[14]);
80 void scsi_setup_read_ext(ccb
*pccb
, lbaint_t start
, unsigned short blocks
)
82 pccb
->cmd
[0] = SCSI_READ10
;
83 pccb
->cmd
[1] = pccb
->lun
<< 5;
84 pccb
->cmd
[2] = (unsigned char)(start
>> 24) & 0xff;
85 pccb
->cmd
[3] = (unsigned char)(start
>> 16) & 0xff;
86 pccb
->cmd
[4] = (unsigned char)(start
>> 8) & 0xff;
87 pccb
->cmd
[5] = (unsigned char)start
& 0xff;
89 pccb
->cmd
[7] = (unsigned char)(blocks
>> 8) & 0xff;
90 pccb
->cmd
[8] = (unsigned char)blocks
& 0xff;
93 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
94 debug("scsi_setup_read_ext: cmd: %02X %02X startblk %02X%02X%02X%02X blccnt %02X%02X\n",
95 pccb
->cmd
[0], pccb
->cmd
[1],
96 pccb
->cmd
[2], pccb
->cmd
[3], pccb
->cmd
[4], pccb
->cmd
[5],
97 pccb
->cmd
[7], pccb
->cmd
[8]);
100 void scsi_setup_write_ext(ccb
*pccb
, lbaint_t start
, unsigned short blocks
)
102 pccb
->cmd
[0] = SCSI_WRITE10
;
103 pccb
->cmd
[1] = pccb
->lun
<< 5;
104 pccb
->cmd
[2] = (unsigned char)(start
>> 24) & 0xff;
105 pccb
->cmd
[3] = (unsigned char)(start
>> 16) & 0xff;
106 pccb
->cmd
[4] = (unsigned char)(start
>> 8) & 0xff;
107 pccb
->cmd
[5] = (unsigned char)start
& 0xff;
109 pccb
->cmd
[7] = ((unsigned char)(blocks
>> 8)) & 0xff;
110 pccb
->cmd
[8] = (unsigned char)blocks
& 0xff;
113 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
114 debug("%s: cmd: %02X %02X startblk %02X%02X%02X%02X blccnt %02X%02X\n",
116 pccb
->cmd
[0], pccb
->cmd
[1],
117 pccb
->cmd
[2], pccb
->cmd
[3], pccb
->cmd
[4], pccb
->cmd
[5],
118 pccb
->cmd
[7], pccb
->cmd
[8]);
121 void scsi_setup_read6(ccb
*pccb
, lbaint_t start
, unsigned short blocks
)
123 pccb
->cmd
[0] = SCSI_READ6
;
124 pccb
->cmd
[1] = pccb
->lun
<< 5 | ((unsigned char)(start
>> 16) & 0x1f);
125 pccb
->cmd
[2] = (unsigned char)(start
>> 8) & 0xff;
126 pccb
->cmd
[3] = (unsigned char)start
& 0xff;
127 pccb
->cmd
[4] = (unsigned char)blocks
& 0xff;
130 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
131 debug("scsi_setup_read6: cmd: %02X %02X startblk %02X%02X blccnt %02X\n",
132 pccb
->cmd
[0], pccb
->cmd
[1],
133 pccb
->cmd
[2], pccb
->cmd
[3], pccb
->cmd
[4]);
137 void scsi_setup_inquiry(ccb
*pccb
)
139 pccb
->cmd
[0] = SCSI_INQUIRY
;
140 pccb
->cmd
[1] = pccb
->lun
<< 5;
143 if (pccb
->datalen
> 255)
146 pccb
->cmd
[4] = (unsigned char)pccb
->datalen
;
149 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
152 static ulong
scsi_read(struct blk_desc
*block_dev
, lbaint_t blknr
,
153 lbaint_t blkcnt
, void *buffer
)
155 int device
= block_dev
->devnum
;
156 lbaint_t start
, blks
;
158 unsigned short smallblks
= 0;
159 ccb
*pccb
= (ccb
*)&tempccb
;
163 pccb
->target
= scsi_dev_desc
[device
].target
;
164 pccb
->lun
= scsi_dev_desc
[device
].lun
;
165 buf_addr
= (unsigned long)buffer
;
168 debug("\nscsi_read: dev %d startblk " LBAF
169 ", blccnt " LBAF
" buffer %lx\n",
170 device
, start
, blks
, (unsigned long)buffer
);
172 pccb
->pdata
= (unsigned char *)buf_addr
;
173 #ifdef CONFIG_SYS_64BIT_LBA
174 if (start
> SCSI_LBA48_READ
) {
175 unsigned long blocks
;
176 blocks
= min_t(lbaint_t
, blks
, SCSI_MAX_READ_BLK
);
177 pccb
->datalen
= scsi_dev_desc
[device
].blksz
* blocks
;
178 scsi_setup_read16(pccb
, start
, blocks
);
183 if (blks
> SCSI_MAX_READ_BLK
) {
184 pccb
->datalen
= scsi_dev_desc
[device
].blksz
*
186 smallblks
= SCSI_MAX_READ_BLK
;
187 scsi_setup_read_ext(pccb
, start
, smallblks
);
188 start
+= SCSI_MAX_READ_BLK
;
189 blks
-= SCSI_MAX_READ_BLK
;
191 pccb
->datalen
= scsi_dev_desc
[device
].blksz
* blks
;
192 smallblks
= (unsigned short)blks
;
193 scsi_setup_read_ext(pccb
, start
, smallblks
);
197 debug("scsi_read_ext: startblk " LBAF
198 ", blccnt %x buffer %" PRIXPTR
"\n",
199 start
, smallblks
, buf_addr
);
200 if (scsi_exec(pccb
) != true) {
201 scsi_print_error(pccb
);
205 buf_addr
+= pccb
->datalen
;
207 debug("scsi_read_ext: end startblk " LBAF
208 ", blccnt %x buffer %" PRIXPTR
"\n", start
, smallblks
, buf_addr
);
212 /*******************************************************************************
216 /* Almost the maximum amount of the scsi_ext command.. */
217 #define SCSI_MAX_WRITE_BLK 0xFFFF
219 static ulong
scsi_write(struct blk_desc
*block_dev
, lbaint_t blknr
,
220 lbaint_t blkcnt
, const void *buffer
)
222 int device
= block_dev
->devnum
;
223 lbaint_t start
, blks
;
225 unsigned short smallblks
;
226 ccb
*pccb
= (ccb
*)&tempccb
;
231 pccb
->target
= scsi_dev_desc
[device
].target
;
232 pccb
->lun
= scsi_dev_desc
[device
].lun
;
233 buf_addr
= (unsigned long)buffer
;
236 debug("\n%s: dev %d startblk " LBAF
", blccnt " LBAF
" buffer %lx\n",
237 __func__
, device
, start
, blks
, (unsigned long)buffer
);
239 pccb
->pdata
= (unsigned char *)buf_addr
;
240 if (blks
> SCSI_MAX_WRITE_BLK
) {
241 pccb
->datalen
= (scsi_dev_desc
[device
].blksz
*
243 smallblks
= SCSI_MAX_WRITE_BLK
;
244 scsi_setup_write_ext(pccb
, start
, smallblks
);
245 start
+= SCSI_MAX_WRITE_BLK
;
246 blks
-= SCSI_MAX_WRITE_BLK
;
248 pccb
->datalen
= scsi_dev_desc
[device
].blksz
* blks
;
249 smallblks
= (unsigned short)blks
;
250 scsi_setup_write_ext(pccb
, start
, smallblks
);
254 debug("%s: startblk " LBAF
", blccnt %x buffer %" PRIXPTR
"\n",
255 __func__
, start
, smallblks
, buf_addr
);
256 if (scsi_exec(pccb
) != true) {
257 scsi_print_error(pccb
);
261 buf_addr
+= pccb
->datalen
;
263 debug("%s: end startblk " LBAF
", blccnt %x buffer %" PRIXPTR
"\n",
264 __func__
, start
, smallblks
, buf_addr
);
268 int scsi_get_disk_count(void)
270 return scsi_max_devs
;
273 #if defined(CONFIG_PCI) && !defined(CONFIG_SCSI_AHCI_PLAT)
279 * Find a device from the list, this driver will support a single
282 for (i
= 0; i
< ARRAY_SIZE(scsi_device_list
); i
++) {
283 /* get PCI Device ID */
288 ret
= dm_pci_find_device(scsi_device_list
[i
].vendor
,
289 scsi_device_list
[i
].device
, 0, &dev
);
291 busdevfunc
= dm_pci_get_bdf(dev
);
295 busdevfunc
= pci_find_device(scsi_device_list
[i
].vendor
,
296 scsi_device_list
[i
].device
,
299 if (busdevfunc
!= -1)
303 if (busdevfunc
== -1) {
304 printf("Error: SCSI Controller(s) ");
305 for (i
= 0; i
< ARRAY_SIZE(scsi_device_list
); i
++) {
307 scsi_device_list
[i
].vendor
,
308 scsi_device_list
[i
].device
);
310 printf("not found\n");
315 printf("SCSI Controller (%04X,%04X) found (%d:%d:%d)\n",
316 scsi_device_list
[i
].vendor
,
317 scsi_device_list
[i
].device
,
318 (busdevfunc
>> 16) & 0xFF,
319 (busdevfunc
>> 11) & 0x1F,
320 (busdevfunc
>> 8) & 0x7);
323 bootstage_start(BOOTSTAGE_ID_ACCUM_SCSI
, "ahci");
324 scsi_low_level_init(busdevfunc
);
326 bootstage_accum(BOOTSTAGE_ID_ACCUM_SCSI
);
330 /* copy src to dest, skipping leading and trailing blanks
331 * and null terminate the string
333 void scsi_ident_cpy(unsigned char *dest
, unsigned char *src
, unsigned int len
)
338 while (start
< len
) {
339 if (src
[start
] != ' ')
344 while (end
> start
) {
349 for (; start
<= end
; start
++)
350 *dest
++= src
[start
];
355 /* Trim trailing blanks, and NUL-terminate string
357 void scsi_trim_trail(unsigned char *str
, unsigned int len
)
359 unsigned char *p
= str
+ len
- 1;
368 int scsi_read_capacity(ccb
*pccb
, lbaint_t
*capacity
, unsigned long *blksz
)
372 memset(pccb
->cmd
, '\0', sizeof(pccb
->cmd
));
373 pccb
->cmd
[0] = SCSI_RD_CAPAC10
;
374 pccb
->cmd
[1] = pccb
->lun
<< 5;
376 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
379 if (scsi_exec(pccb
) != true)
382 *capacity
= ((lbaint_t
)pccb
->pdata
[0] << 24) |
383 ((lbaint_t
)pccb
->pdata
[1] << 16) |
384 ((lbaint_t
)pccb
->pdata
[2] << 8) |
385 ((lbaint_t
)pccb
->pdata
[3]);
387 if (*capacity
!= 0xffffffff) {
388 /* Read capacity (10) was sufficient for this drive. */
389 *blksz
= ((unsigned long)pccb
->pdata
[4] << 24) |
390 ((unsigned long)pccb
->pdata
[5] << 16) |
391 ((unsigned long)pccb
->pdata
[6] << 8) |
392 ((unsigned long)pccb
->pdata
[7]);
396 /* Read capacity (10) was insufficient. Use read capacity (16). */
397 memset(pccb
->cmd
, '\0', sizeof(pccb
->cmd
));
398 pccb
->cmd
[0] = SCSI_RD_CAPAC16
;
401 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
404 if (scsi_exec(pccb
) != true)
407 *capacity
= ((uint64_t)pccb
->pdata
[0] << 56) |
408 ((uint64_t)pccb
->pdata
[1] << 48) |
409 ((uint64_t)pccb
->pdata
[2] << 40) |
410 ((uint64_t)pccb
->pdata
[3] << 32) |
411 ((uint64_t)pccb
->pdata
[4] << 24) |
412 ((uint64_t)pccb
->pdata
[5] << 16) |
413 ((uint64_t)pccb
->pdata
[6] << 8) |
414 ((uint64_t)pccb
->pdata
[7]);
416 *blksz
= ((uint64_t)pccb
->pdata
[8] << 56) |
417 ((uint64_t)pccb
->pdata
[9] << 48) |
418 ((uint64_t)pccb
->pdata
[10] << 40) |
419 ((uint64_t)pccb
->pdata
[11] << 32) |
420 ((uint64_t)pccb
->pdata
[12] << 24) |
421 ((uint64_t)pccb
->pdata
[13] << 16) |
422 ((uint64_t)pccb
->pdata
[14] << 8) |
423 ((uint64_t)pccb
->pdata
[15]);
430 * Some setup (fill-in) routines
432 void scsi_setup_test_unit_ready(ccb
*pccb
)
434 pccb
->cmd
[0] = SCSI_TST_U_RDY
;
435 pccb
->cmd
[1] = pccb
->lun
<< 5;
441 pccb
->msgout
[0] = SCSI_IDENTIFY
; /* NOT USED */
445 * (re)-scan the scsi bus and reports scsi device info
446 * to the user if mode = 1
448 void scsi_scan(int mode
)
450 unsigned char i
, perq
, modi
, lun
;
453 ccb
*pccb
= (ccb
*)&tempccb
;
456 printf("scanning bus for devices...\n");
457 for (i
= 0; i
< CONFIG_SYS_SCSI_MAX_DEVICE
; i
++) {
458 scsi_dev_desc
[i
].target
= 0xff;
459 scsi_dev_desc
[i
].lun
= 0xff;
460 scsi_dev_desc
[i
].lba
= 0;
461 scsi_dev_desc
[i
].blksz
= 0;
462 scsi_dev_desc
[i
].log2blksz
=
463 LOG2_INVALID(typeof(scsi_dev_desc
[i
].log2blksz
));
464 scsi_dev_desc
[i
].type
= DEV_TYPE_UNKNOWN
;
465 scsi_dev_desc
[i
].vendor
[0] = 0;
466 scsi_dev_desc
[i
].product
[0] = 0;
467 scsi_dev_desc
[i
].revision
[0] = 0;
468 scsi_dev_desc
[i
].removable
= false;
469 scsi_dev_desc
[i
].if_type
= IF_TYPE_SCSI
;
470 scsi_dev_desc
[i
].devnum
= i
;
471 scsi_dev_desc
[i
].part_type
= PART_TYPE_UNKNOWN
;
472 scsi_dev_desc
[i
].block_read
= scsi_read
;
473 scsi_dev_desc
[i
].block_write
= scsi_write
;
476 for (i
= 0; i
< CONFIG_SYS_SCSI_MAX_SCSI_ID
; i
++) {
478 for (lun
= 0; lun
< CONFIG_SYS_SCSI_MAX_LUN
; lun
++) {
480 pccb
->pdata
= (unsigned char *)&tempbuff
;
482 scsi_setup_inquiry(pccb
);
483 if (scsi_exec(pccb
) != true) {
484 if (pccb
->contr_stat
== SCSI_SEL_TIME_OUT
) {
486 * selection timeout => assuming no
489 debug("Selection timeout ID %d\n",
493 scsi_print_error(pccb
);
498 if ((perq
& 0x1f) == 0x1f)
499 continue; /* skip unknown devices */
500 if ((modi
& 0x80) == 0x80) /* drive is removable */
501 scsi_dev_desc
[scsi_max_devs
].removable
= true;
502 /* get info for this device */
503 scsi_ident_cpy((unsigned char *)&scsi_dev_desc
504 [scsi_max_devs
].vendor
[0],
506 scsi_ident_cpy((unsigned char *)&scsi_dev_desc
507 [scsi_max_devs
].product
[0],
509 scsi_ident_cpy((unsigned char *)&scsi_dev_desc
510 [scsi_max_devs
].revision
[0],
512 scsi_dev_desc
[scsi_max_devs
].target
= pccb
->target
;
513 scsi_dev_desc
[scsi_max_devs
].lun
= pccb
->lun
;
516 scsi_setup_test_unit_ready(pccb
);
517 if (scsi_exec(pccb
) != true) {
518 if (scsi_dev_desc
[scsi_max_devs
].removable
) {
519 scsi_dev_desc
[scsi_max_devs
].type
=
523 scsi_print_error(pccb
);
526 if (scsi_read_capacity(pccb
, &capacity
, &blksz
)) {
527 scsi_print_error(pccb
);
530 scsi_dev_desc
[scsi_max_devs
].lba
= capacity
;
531 scsi_dev_desc
[scsi_max_devs
].blksz
= blksz
;
532 scsi_dev_desc
[scsi_max_devs
].log2blksz
=
533 LOG2(scsi_dev_desc
[scsi_max_devs
].blksz
);
534 scsi_dev_desc
[scsi_max_devs
].type
= perq
;
535 part_init(&scsi_dev_desc
[scsi_max_devs
]);
538 printf(" Device %d: ", scsi_max_devs
);
539 dev_print(&scsi_dev_desc
[scsi_max_devs
]);
544 if (scsi_max_devs
> 0)
549 printf("Found %d device(s).\n", scsi_max_devs
);
550 #ifndef CONFIG_SPL_BUILD
551 setenv_ulong("scsidevs", scsi_max_devs
);
555 U_BOOT_LEGACY_BLK(scsi
) = {
556 .if_typename
= "sata",
557 .if_type
= IF_TYPE_SCSI
,
558 .max_devs
= CONFIG_SYS_SCSI_MAX_DEVICE
,
559 .desc
= scsi_dev_desc
,