]> git.ipfire.org Git - thirdparty/u-boot.git/blame - drivers/scsi/scsi.c
cbfs: Allow CBFS to be used in SPL
[thirdparty/u-boot.git] / drivers / scsi / scsi.c
CommitLineData
83d290c5 1// SPDX-License-Identifier: GPL-2.0+
11f610ed
SG
2/*
3 * (C) Copyright 2001
4 * Denis Peter, MPL AG Switzerland
11f610ed
SG
5 */
6
7#include <common.h>
535556b2 8#include <dm.h>
168068fb 9#include <env.h>
11f610ed
SG
10#include <pci.h>
11#include <scsi.h>
e8a016b5
MS
12#include <dm/device-internal.h>
13#include <dm/uclass-internal.h>
11f610ed 14
e8a016b5 15#if !defined(CONFIG_DM_SCSI)
099c239d
SG
16# ifdef CONFIG_SCSI_DEV_LIST
17# define SCSI_DEV_LIST CONFIG_SCSI_DEV_LIST
18# else
19# ifdef CONFIG_SATA_ULI5288
11f610ed 20
099c239d
SG
21# define SCSI_VEND_ID 0x10b9
22# define SCSI_DEV_ID 0x5288
11f610ed 23
099c239d
SG
24# elif !defined(CONFIG_SCSI_AHCI_PLAT)
25# error no scsi device defined
26# endif
27# define SCSI_DEV_LIST {SCSI_VEND_ID, SCSI_DEV_ID}
28# endif
e8a016b5 29#endif
11f610ed 30
7337fcd8
SG
31#if defined(CONFIG_PCI) && !defined(CONFIG_SCSI_AHCI_PLAT) && \
32 !defined(CONFIG_DM_SCSI)
11f610ed
SG
33const struct pci_device_id scsi_device_list[] = { SCSI_DEV_LIST };
34#endif
b9560ad6 35static struct scsi_cmd tempccb; /* temporary scsi command buffer */
11f610ed
SG
36
37static unsigned char tempbuff[512]; /* temporary data buffer */
38
e8a016b5 39#if !defined(CONFIG_DM_SCSI)
11f610ed
SG
40static int scsi_max_devs; /* number of highest available scsi device */
41
42static int scsi_curr_dev; /* current device */
43
44static struct blk_desc scsi_dev_desc[CONFIG_SYS_SCSI_MAX_DEVICE];
e8a016b5 45#endif
11f610ed
SG
46
47/* almost the maximum amount of the scsi_ext command.. */
48#define SCSI_MAX_READ_BLK 0xFFFF
49#define SCSI_LBA48_READ 0xFFFFFFF
50
b9560ad6 51static void scsi_print_error(struct scsi_cmd *pccb)
a6fb185c
SG
52{
53 /* Dummy function that could print an error for debugging */
54}
55
11f610ed 56#ifdef CONFIG_SYS_64BIT_LBA
b9560ad6
SG
57void scsi_setup_read16(struct scsi_cmd *pccb, lbaint_t start,
58 unsigned long blocks)
11f610ed
SG
59{
60 pccb->cmd[0] = SCSI_READ16;
61 pccb->cmd[1] = pccb->lun << 5;
62 pccb->cmd[2] = (unsigned char)(start >> 56) & 0xff;
63 pccb->cmd[3] = (unsigned char)(start >> 48) & 0xff;
64 pccb->cmd[4] = (unsigned char)(start >> 40) & 0xff;
65 pccb->cmd[5] = (unsigned char)(start >> 32) & 0xff;
66 pccb->cmd[6] = (unsigned char)(start >> 24) & 0xff;
67 pccb->cmd[7] = (unsigned char)(start >> 16) & 0xff;
68 pccb->cmd[8] = (unsigned char)(start >> 8) & 0xff;
69 pccb->cmd[9] = (unsigned char)start & 0xff;
70 pccb->cmd[10] = 0;
71 pccb->cmd[11] = (unsigned char)(blocks >> 24) & 0xff;
72 pccb->cmd[12] = (unsigned char)(blocks >> 16) & 0xff;
73 pccb->cmd[13] = (unsigned char)(blocks >> 8) & 0xff;
74 pccb->cmd[14] = (unsigned char)blocks & 0xff;
75 pccb->cmd[15] = 0;
76 pccb->cmdlen = 16;
77 pccb->msgout[0] = SCSI_IDENTIFY; /* NOT USED */
78 debug("scsi_setup_read16: cmd: %02X %02X startblk %02X%02X%02X%02X%02X%02X%02X%02X blccnt %02X%02X%02X%02X\n",
79 pccb->cmd[0], pccb->cmd[1],
80 pccb->cmd[2], pccb->cmd[3], pccb->cmd[4], pccb->cmd[5],
81 pccb->cmd[6], pccb->cmd[7], pccb->cmd[8], pccb->cmd[9],
82 pccb->cmd[11], pccb->cmd[12], pccb->cmd[13], pccb->cmd[14]);
83}
84#endif
85
b9560ad6 86static void scsi_setup_read_ext(struct scsi_cmd *pccb, lbaint_t start,
545a2847 87 unsigned short blocks)
11f610ed
SG
88{
89 pccb->cmd[0] = SCSI_READ10;
90 pccb->cmd[1] = pccb->lun << 5;
91 pccb->cmd[2] = (unsigned char)(start >> 24) & 0xff;
92 pccb->cmd[3] = (unsigned char)(start >> 16) & 0xff;
93 pccb->cmd[4] = (unsigned char)(start >> 8) & 0xff;
94 pccb->cmd[5] = (unsigned char)start & 0xff;
95 pccb->cmd[6] = 0;
96 pccb->cmd[7] = (unsigned char)(blocks >> 8) & 0xff;
97 pccb->cmd[8] = (unsigned char)blocks & 0xff;
98 pccb->cmd[6] = 0;
99 pccb->cmdlen = 10;
100 pccb->msgout[0] = SCSI_IDENTIFY; /* NOT USED */
101 debug("scsi_setup_read_ext: cmd: %02X %02X startblk %02X%02X%02X%02X blccnt %02X%02X\n",
102 pccb->cmd[0], pccb->cmd[1],
103 pccb->cmd[2], pccb->cmd[3], pccb->cmd[4], pccb->cmd[5],
104 pccb->cmd[7], pccb->cmd[8]);
105}
106
b9560ad6 107static void scsi_setup_write_ext(struct scsi_cmd *pccb, lbaint_t start,
545a2847 108 unsigned short blocks)
11f610ed
SG
109{
110 pccb->cmd[0] = SCSI_WRITE10;
111 pccb->cmd[1] = pccb->lun << 5;
112 pccb->cmd[2] = (unsigned char)(start >> 24) & 0xff;
113 pccb->cmd[3] = (unsigned char)(start >> 16) & 0xff;
114 pccb->cmd[4] = (unsigned char)(start >> 8) & 0xff;
115 pccb->cmd[5] = (unsigned char)start & 0xff;
116 pccb->cmd[6] = 0;
117 pccb->cmd[7] = ((unsigned char)(blocks >> 8)) & 0xff;
118 pccb->cmd[8] = (unsigned char)blocks & 0xff;
119 pccb->cmd[9] = 0;
120 pccb->cmdlen = 10;
121 pccb->msgout[0] = SCSI_IDENTIFY; /* NOT USED */
122 debug("%s: cmd: %02X %02X startblk %02X%02X%02X%02X blccnt %02X%02X\n",
123 __func__,
124 pccb->cmd[0], pccb->cmd[1],
125 pccb->cmd[2], pccb->cmd[3], pccb->cmd[4], pccb->cmd[5],
126 pccb->cmd[7], pccb->cmd[8]);
127}
128
b9560ad6 129static void scsi_setup_inquiry(struct scsi_cmd *pccb)
11f610ed
SG
130{
131 pccb->cmd[0] = SCSI_INQUIRY;
132 pccb->cmd[1] = pccb->lun << 5;
133 pccb->cmd[2] = 0;
134 pccb->cmd[3] = 0;
135 if (pccb->datalen > 255)
136 pccb->cmd[4] = 255;
137 else
138 pccb->cmd[4] = (unsigned char)pccb->datalen;
139 pccb->cmd[5] = 0;
140 pccb->cmdlen = 6;
141 pccb->msgout[0] = SCSI_IDENTIFY; /* NOT USED */
142}
143
535556b2
SG
144#ifdef CONFIG_BLK
145static ulong scsi_read(struct udevice *dev, lbaint_t blknr, lbaint_t blkcnt,
146 void *buffer)
147#else
11f610ed
SG
148static ulong scsi_read(struct blk_desc *block_dev, lbaint_t blknr,
149 lbaint_t blkcnt, void *buffer)
535556b2 150#endif
11f610ed 151{
535556b2
SG
152#ifdef CONFIG_BLK
153 struct blk_desc *block_dev = dev_get_uclass_platdata(dev);
4682c8a1
SG
154 struct udevice *bdev = dev->parent;
155#else
156 struct udevice *bdev = NULL;
535556b2 157#endif
11f610ed
SG
158 lbaint_t start, blks;
159 uintptr_t buf_addr;
160 unsigned short smallblks = 0;
b9560ad6 161 struct scsi_cmd *pccb = (struct scsi_cmd *)&tempccb;
11f610ed
SG
162
163 /* Setup device */
cdb93b27
MS
164 pccb->target = block_dev->target;
165 pccb->lun = block_dev->lun;
11f610ed
SG
166 buf_addr = (unsigned long)buffer;
167 start = blknr;
168 blks = blkcnt;
169 debug("\nscsi_read: dev %d startblk " LBAF
170 ", blccnt " LBAF " buffer %lx\n",
cdb93b27 171 block_dev->devnum, start, blks, (unsigned long)buffer);
11f610ed
SG
172 do {
173 pccb->pdata = (unsigned char *)buf_addr;
174#ifdef CONFIG_SYS_64BIT_LBA
175 if (start > SCSI_LBA48_READ) {
176 unsigned long blocks;
177 blocks = min_t(lbaint_t, blks, SCSI_MAX_READ_BLK);
cdb93b27 178 pccb->datalen = block_dev->blksz * blocks;
11f610ed
SG
179 scsi_setup_read16(pccb, start, blocks);
180 start += blocks;
181 blks -= blocks;
182 } else
183#endif
184 if (blks > SCSI_MAX_READ_BLK) {
cdb93b27 185 pccb->datalen = block_dev->blksz *
11f610ed
SG
186 SCSI_MAX_READ_BLK;
187 smallblks = SCSI_MAX_READ_BLK;
188 scsi_setup_read_ext(pccb, start, smallblks);
189 start += SCSI_MAX_READ_BLK;
190 blks -= SCSI_MAX_READ_BLK;
191 } else {
cdb93b27 192 pccb->datalen = block_dev->blksz * blks;
11f610ed
SG
193 smallblks = (unsigned short)blks;
194 scsi_setup_read_ext(pccb, start, smallblks);
195 start += blks;
196 blks = 0;
197 }
198 debug("scsi_read_ext: startblk " LBAF
dee37fc9 199 ", blccnt %x buffer %lX\n",
11f610ed 200 start, smallblks, buf_addr);
4682c8a1 201 if (scsi_exec(bdev, pccb)) {
11f610ed
SG
202 scsi_print_error(pccb);
203 blkcnt -= blks;
204 break;
205 }
206 buf_addr += pccb->datalen;
207 } while (blks != 0);
208 debug("scsi_read_ext: end startblk " LBAF
dee37fc9 209 ", blccnt %x buffer %lX\n", start, smallblks, buf_addr);
11f610ed
SG
210 return blkcnt;
211}
212
213/*******************************************************************************
214 * scsi_write
215 */
216
217/* Almost the maximum amount of the scsi_ext command.. */
218#define SCSI_MAX_WRITE_BLK 0xFFFF
219
535556b2
SG
220#ifdef CONFIG_BLK
221static ulong scsi_write(struct udevice *dev, lbaint_t blknr, lbaint_t blkcnt,
222 const void *buffer)
223#else
11f610ed
SG
224static ulong scsi_write(struct blk_desc *block_dev, lbaint_t blknr,
225 lbaint_t blkcnt, const void *buffer)
535556b2 226#endif
11f610ed 227{
535556b2
SG
228#ifdef CONFIG_BLK
229 struct blk_desc *block_dev = dev_get_uclass_platdata(dev);
4682c8a1
SG
230 struct udevice *bdev = dev->parent;
231#else
232 struct udevice *bdev = NULL;
535556b2 233#endif
11f610ed
SG
234 lbaint_t start, blks;
235 uintptr_t buf_addr;
236 unsigned short smallblks;
b9560ad6 237 struct scsi_cmd *pccb = (struct scsi_cmd *)&tempccb;
11f610ed 238
11f610ed 239 /* Setup device */
cdb93b27
MS
240 pccb->target = block_dev->target;
241 pccb->lun = block_dev->lun;
11f610ed
SG
242 buf_addr = (unsigned long)buffer;
243 start = blknr;
244 blks = blkcnt;
245 debug("\n%s: dev %d startblk " LBAF ", blccnt " LBAF " buffer %lx\n",
cdb93b27 246 __func__, block_dev->devnum, start, blks, (unsigned long)buffer);
11f610ed
SG
247 do {
248 pccb->pdata = (unsigned char *)buf_addr;
249 if (blks > SCSI_MAX_WRITE_BLK) {
cdb93b27 250 pccb->datalen = (block_dev->blksz *
11f610ed
SG
251 SCSI_MAX_WRITE_BLK);
252 smallblks = SCSI_MAX_WRITE_BLK;
253 scsi_setup_write_ext(pccb, start, smallblks);
254 start += SCSI_MAX_WRITE_BLK;
255 blks -= SCSI_MAX_WRITE_BLK;
256 } else {
cdb93b27 257 pccb->datalen = block_dev->blksz * blks;
11f610ed
SG
258 smallblks = (unsigned short)blks;
259 scsi_setup_write_ext(pccb, start, smallblks);
260 start += blks;
261 blks = 0;
262 }
dee37fc9 263 debug("%s: startblk " LBAF ", blccnt %x buffer %lx\n",
11f610ed 264 __func__, start, smallblks, buf_addr);
4682c8a1 265 if (scsi_exec(bdev, pccb)) {
11f610ed
SG
266 scsi_print_error(pccb);
267 blkcnt -= blks;
268 break;
269 }
270 buf_addr += pccb->datalen;
271 } while (blks != 0);
dee37fc9 272 debug("%s: end startblk " LBAF ", blccnt %x buffer %lX\n",
11f610ed
SG
273 __func__, start, smallblks, buf_addr);
274 return blkcnt;
275}
276
7337fcd8
SG
277#if defined(CONFIG_PCI) && !defined(CONFIG_SCSI_AHCI_PLAT) && \
278 !defined(CONFIG_DM_SCSI)
11f610ed
SG
279void scsi_init(void)
280{
281 int busdevfunc = -1;
282 int i;
283 /*
284 * Find a device from the list, this driver will support a single
285 * controller.
286 */
287 for (i = 0; i < ARRAY_SIZE(scsi_device_list); i++) {
288 /* get PCI Device ID */
289#ifdef CONFIG_DM_PCI
290 struct udevice *dev;
291 int ret;
292
293 ret = dm_pci_find_device(scsi_device_list[i].vendor,
294 scsi_device_list[i].device, 0, &dev);
295 if (!ret) {
296 busdevfunc = dm_pci_get_bdf(dev);
297 break;
298 }
299#else
300 busdevfunc = pci_find_device(scsi_device_list[i].vendor,
301 scsi_device_list[i].device,
302 0);
303#endif
304 if (busdevfunc != -1)
305 break;
306 }
307
308 if (busdevfunc == -1) {
309 printf("Error: SCSI Controller(s) ");
310 for (i = 0; i < ARRAY_SIZE(scsi_device_list); i++) {
311 printf("%04X:%04X ",
312 scsi_device_list[i].vendor,
313 scsi_device_list[i].device);
314 }
315 printf("not found\n");
316 return;
317 }
318#ifdef DEBUG
319 else {
320 printf("SCSI Controller (%04X,%04X) found (%d:%d:%d)\n",
321 scsi_device_list[i].vendor,
322 scsi_device_list[i].device,
323 (busdevfunc >> 16) & 0xFF,
324 (busdevfunc >> 11) & 0x1F,
325 (busdevfunc >> 8) & 0x7);
326 }
327#endif
328 bootstage_start(BOOTSTAGE_ID_ACCUM_SCSI, "ahci");
329 scsi_low_level_init(busdevfunc);
8eab1a58 330 scsi_scan(true);
11f610ed
SG
331 bootstage_accum(BOOTSTAGE_ID_ACCUM_SCSI);
332}
333#endif
334
11f610ed
SG
335/* copy src to dest, skipping leading and trailing blanks
336 * and null terminate the string
337 */
545a2847
MS
338static void scsi_ident_cpy(unsigned char *dest, unsigned char *src,
339 unsigned int len)
11f610ed
SG
340{
341 int start, end;
342
343 start = 0;
344 while (start < len) {
345 if (src[start] != ' ')
346 break;
347 start++;
348 }
349 end = len-1;
350 while (end > start) {
351 if (src[end] != ' ')
352 break;
353 end--;
354 }
355 for (; start <= end; start++)
356 *dest ++= src[start];
357 *dest = '\0';
358}
359
4682c8a1
SG
360static int scsi_read_capacity(struct udevice *dev, struct scsi_cmd *pccb,
361 lbaint_t *capacity, unsigned long *blksz)
11f610ed
SG
362{
363 *capacity = 0;
364
365 memset(pccb->cmd, '\0', sizeof(pccb->cmd));
366 pccb->cmd[0] = SCSI_RD_CAPAC10;
367 pccb->cmd[1] = pccb->lun << 5;
368 pccb->cmdlen = 10;
369 pccb->msgout[0] = SCSI_IDENTIFY; /* NOT USED */
370
371 pccb->datalen = 8;
f6580ef3 372 if (scsi_exec(dev, pccb))
11f610ed
SG
373 return 1;
374
375 *capacity = ((lbaint_t)pccb->pdata[0] << 24) |
376 ((lbaint_t)pccb->pdata[1] << 16) |
377 ((lbaint_t)pccb->pdata[2] << 8) |
378 ((lbaint_t)pccb->pdata[3]);
379
380 if (*capacity != 0xffffffff) {
381 /* Read capacity (10) was sufficient for this drive. */
382 *blksz = ((unsigned long)pccb->pdata[4] << 24) |
383 ((unsigned long)pccb->pdata[5] << 16) |
384 ((unsigned long)pccb->pdata[6] << 8) |
385 ((unsigned long)pccb->pdata[7]);
386 return 0;
387 }
388
389 /* Read capacity (10) was insufficient. Use read capacity (16). */
390 memset(pccb->cmd, '\0', sizeof(pccb->cmd));
391 pccb->cmd[0] = SCSI_RD_CAPAC16;
392 pccb->cmd[1] = 0x10;
393 pccb->cmdlen = 16;
394 pccb->msgout[0] = SCSI_IDENTIFY; /* NOT USED */
395
396 pccb->datalen = 16;
f6580ef3 397 if (scsi_exec(dev, pccb))
11f610ed
SG
398 return 1;
399
400 *capacity = ((uint64_t)pccb->pdata[0] << 56) |
401 ((uint64_t)pccb->pdata[1] << 48) |
402 ((uint64_t)pccb->pdata[2] << 40) |
403 ((uint64_t)pccb->pdata[3] << 32) |
404 ((uint64_t)pccb->pdata[4] << 24) |
405 ((uint64_t)pccb->pdata[5] << 16) |
406 ((uint64_t)pccb->pdata[6] << 8) |
407 ((uint64_t)pccb->pdata[7]);
408
409 *blksz = ((uint64_t)pccb->pdata[8] << 56) |
410 ((uint64_t)pccb->pdata[9] << 48) |
411 ((uint64_t)pccb->pdata[10] << 40) |
412 ((uint64_t)pccb->pdata[11] << 32) |
413 ((uint64_t)pccb->pdata[12] << 24) |
414 ((uint64_t)pccb->pdata[13] << 16) |
415 ((uint64_t)pccb->pdata[14] << 8) |
416 ((uint64_t)pccb->pdata[15]);
417
418 return 0;
419}
420
421
422/*
423 * Some setup (fill-in) routines
424 */
b9560ad6 425static void scsi_setup_test_unit_ready(struct scsi_cmd *pccb)
11f610ed
SG
426{
427 pccb->cmd[0] = SCSI_TST_U_RDY;
428 pccb->cmd[1] = pccb->lun << 5;
429 pccb->cmd[2] = 0;
430 pccb->cmd[3] = 0;
431 pccb->cmd[4] = 0;
432 pccb->cmd[5] = 0;
433 pccb->cmdlen = 6;
434 pccb->msgout[0] = SCSI_IDENTIFY; /* NOT USED */
435}
436
0b3a58ee
MS
437/**
438 * scsi_init_dev_desc_priv - initialize only SCSI specific blk_desc properties
439 *
440 * @dev_desc: Block device description pointer
441 */
442static void scsi_init_dev_desc_priv(struct blk_desc *dev_desc)
92ca476c
MS
443{
444 dev_desc->target = 0xff;
445 dev_desc->lun = 0xff;
92ca476c
MS
446 dev_desc->log2blksz =
447 LOG2_INVALID(typeof(dev_desc->log2blksz));
448 dev_desc->type = DEV_TYPE_UNKNOWN;
449 dev_desc->vendor[0] = 0;
450 dev_desc->product[0] = 0;
451 dev_desc->revision[0] = 0;
452 dev_desc->removable = false;
c4d660d4 453#if !CONFIG_IS_ENABLED(BLK)
92ca476c
MS
454 dev_desc->block_read = scsi_read;
455 dev_desc->block_write = scsi_write;
456#endif
457}
458
e8a016b5 459#if !defined(CONFIG_DM_SCSI)
0b3a58ee
MS
460/**
461 * scsi_init_dev_desc - initialize all SCSI specific blk_desc properties
462 *
463 * @dev_desc: Block device description pointer
464 * @devnum: Device number
465 */
466static void scsi_init_dev_desc(struct blk_desc *dev_desc, int devnum)
467{
468 dev_desc->lba = 0;
469 dev_desc->blksz = 0;
470 dev_desc->if_type = IF_TYPE_SCSI;
471 dev_desc->devnum = devnum;
472 dev_desc->part_type = PART_TYPE_UNKNOWN;
473
474 scsi_init_dev_desc_priv(dev_desc);
475}
e8a016b5 476#endif
bccfd9e9 477
570712f4
MS
478/**
479 * scsi_detect_dev - Detect scsi device
480 *
bccfd9e9 481 * @target: target id
e39cecfd 482 * @lun: target lun
570712f4 483 * @dev_desc: block device description
570712f4
MS
484 *
485 * The scsi_detect_dev detects and fills a dev_desc structure when the device is
e39cecfd 486 * detected.
570712f4
MS
487 *
488 * Return: 0 on success, error value otherwise
489 */
4682c8a1
SG
490static int scsi_detect_dev(struct udevice *dev, int target, int lun,
491 struct blk_desc *dev_desc)
570712f4
MS
492{
493 unsigned char perq, modi;
494 lbaint_t capacity;
495 unsigned long blksz;
b9560ad6 496 struct scsi_cmd *pccb = (struct scsi_cmd *)&tempccb;
570712f4 497
bccfd9e9 498 pccb->target = target;
e39cecfd 499 pccb->lun = lun;
570712f4
MS
500 pccb->pdata = (unsigned char *)&tempbuff;
501 pccb->datalen = 512;
502 scsi_setup_inquiry(pccb);
f6580ef3 503 if (scsi_exec(dev, pccb)) {
570712f4
MS
504 if (pccb->contr_stat == SCSI_SEL_TIME_OUT) {
505 /*
506 * selection timeout => assuming no
507 * device present
508 */
509 debug("Selection timeout ID %d\n",
510 pccb->target);
511 return -ETIMEDOUT;
512 }
513 scsi_print_error(pccb);
514 return -ENODEV;
515 }
516 perq = tempbuff[0];
517 modi = tempbuff[1];
518 if ((perq & 0x1f) == 0x1f)
519 return -ENODEV; /* skip unknown devices */
520 if ((modi & 0x80) == 0x80) /* drive is removable */
521 dev_desc->removable = true;
522 /* get info for this device */
523 scsi_ident_cpy((unsigned char *)dev_desc->vendor,
524 &tempbuff[8], 8);
525 scsi_ident_cpy((unsigned char *)dev_desc->product,
526 &tempbuff[16], 16);
527 scsi_ident_cpy((unsigned char *)dev_desc->revision,
528 &tempbuff[32], 4);
529 dev_desc->target = pccb->target;
530 dev_desc->lun = pccb->lun;
531
532 pccb->datalen = 0;
533 scsi_setup_test_unit_ready(pccb);
f6580ef3 534 if (scsi_exec(dev, pccb)) {
570712f4
MS
535 if (dev_desc->removable) {
536 dev_desc->type = perq;
537 goto removable;
538 }
539 scsi_print_error(pccb);
540 return -EINVAL;
541 }
4682c8a1 542 if (scsi_read_capacity(dev, pccb, &capacity, &blksz)) {
570712f4
MS
543 scsi_print_error(pccb);
544 return -EINVAL;
545 }
546 dev_desc->lba = capacity;
547 dev_desc->blksz = blksz;
548 dev_desc->log2blksz = LOG2(dev_desc->blksz);
549 dev_desc->type = perq;
570712f4
MS
550removable:
551 return 0;
552}
553
11f610ed
SG
554/*
555 * (re)-scan the scsi bus and reports scsi device info
556 * to the user if mode = 1
557 */
e8a016b5 558#if defined(CONFIG_DM_SCSI)
8eab1a58 559static int do_scsi_scan_one(struct udevice *dev, int id, int lun, bool verbose)
d52063b8
JJH
560{
561 int ret;
562 struct udevice *bdev;
563 struct blk_desc bd;
564 struct blk_desc *bdesc;
565 char str[10];
566
567 /*
568 * detect the scsi driver to get information about its geometry (block
569 * size, number of blocks) and other parameters (ids, type, ...)
570 */
571 scsi_init_dev_desc_priv(&bd);
4682c8a1 572 if (scsi_detect_dev(dev, id, lun, &bd))
d52063b8
JJH
573 return -ENODEV;
574
575 /*
576 * Create only one block device and do detection
577 * to make sure that there won't be a lot of
578 * block devices created
579 */
580 snprintf(str, sizeof(str), "id%dlun%d", id, lun);
581 ret = blk_create_devicef(dev, "scsi_blk", str, IF_TYPE_SCSI, -1,
5fe7702e 582 bd.blksz, bd.lba, &bdev);
d52063b8
JJH
583 if (ret) {
584 debug("Can't create device\n");
585 return ret;
586 }
587
588 bdesc = dev_get_uclass_platdata(bdev);
589 bdesc->target = id;
590 bdesc->lun = lun;
591 bdesc->removable = bd.removable;
592 bdesc->type = bd.type;
593 memcpy(&bdesc->vendor, &bd.vendor, sizeof(bd.vendor));
594 memcpy(&bdesc->product, &bd.product, sizeof(bd.product));
595 memcpy(&bdesc->revision, &bd.revision, sizeof(bd.revision));
d52063b8 596
8eab1a58 597 if (verbose) {
90037d4c 598 printf(" Device %d: ", bdesc->devnum);
d52063b8
JJH
599 dev_print(bdesc);
600 }
601 return 0;
602}
603
5c561763
SG
604int scsi_scan_dev(struct udevice *dev, bool verbose)
605{
606 struct scsi_platdata *uc_plat; /* scsi controller platdata */
607 int ret;
608 int i;
609 int lun;
610
611 /* probe SCSI controller driver */
612 ret = device_probe(dev);
613 if (ret)
614 return ret;
615
616 /* Get controller platdata */
617 uc_plat = dev_get_uclass_platdata(dev);
618
619 for (i = 0; i < uc_plat->max_id; i++)
620 for (lun = 0; lun < uc_plat->max_lun; lun++)
621 do_scsi_scan_one(dev, i, lun, verbose);
622
623 return 0;
624}
625
8eab1a58 626int scsi_scan(bool verbose)
e8a016b5 627{
e8a016b5
MS
628 struct uclass *uc;
629 struct udevice *dev; /* SCSI controller */
630 int ret;
631
8eab1a58 632 if (verbose)
e8a016b5
MS
633 printf("scanning bus for devices...\n");
634
f8f41ae6
MS
635 blk_unbind_all(IF_TYPE_SCSI);
636
e8a016b5
MS
637 ret = uclass_get(UCLASS_SCSI, &uc);
638 if (ret)
639 return ret;
640
641 uclass_foreach_dev(dev, uc) {
5c561763 642 ret = scsi_scan_dev(dev, verbose);
e8a016b5
MS
643 if (ret)
644 return ret;
e8a016b5
MS
645 }
646
647 return 0;
648}
649#else
8eab1a58 650int scsi_scan(bool verbose)
11f610ed 651{
570712f4
MS
652 unsigned char i, lun;
653 int ret;
11f610ed 654
8eab1a58 655 if (verbose)
11f610ed 656 printf("scanning bus for devices...\n");
92ca476c
MS
657 for (i = 0; i < CONFIG_SYS_SCSI_MAX_DEVICE; i++)
658 scsi_init_dev_desc(&scsi_dev_desc[i], i);
659
11f610ed
SG
660 scsi_max_devs = 0;
661 for (i = 0; i < CONFIG_SYS_SCSI_MAX_SCSI_ID; i++) {
11f610ed 662 for (lun = 0; lun < CONFIG_SYS_SCSI_MAX_LUN; lun++) {
90037d4c
HS
663 struct blk_desc *bdesc = &scsi_dev_desc[scsi_max_devs];
664
665 ret = scsi_detect_dev(NULL, i, lun, bdesc);
570712f4 666 if (ret)
11f610ed 667 continue;
90037d4c 668 part_init(bdesc);
570712f4 669
8eab1a58 670 if (verbose) {
90037d4c
HS
671 printf(" Device %d: ", bdesc->devnum);
672 dev_print(bdesc);
8eab1a58 673 }
11f610ed
SG
674 scsi_max_devs++;
675 } /* next LUN */
676 }
677 if (scsi_max_devs > 0)
678 scsi_curr_dev = 0;
679 else
680 scsi_curr_dev = -1;
681
682 printf("Found %d device(s).\n", scsi_max_devs);
683#ifndef CONFIG_SPL_BUILD
018f5303 684 env_set_ulong("scsidevs", scsi_max_devs);
11f610ed 685#endif
c002e39a 686 return 0;
11f610ed 687}
e8a016b5 688#endif
11f610ed 689
535556b2
SG
690#ifdef CONFIG_BLK
691static const struct blk_ops scsi_blk_ops = {
692 .read = scsi_read,
693 .write = scsi_write,
694};
695
696U_BOOT_DRIVER(scsi_blk) = {
697 .name = "scsi_blk",
698 .id = UCLASS_BLK,
699 .ops = &scsi_blk_ops,
700};
701#else
11f610ed 702U_BOOT_LEGACY_BLK(scsi) = {
69c125fe 703 .if_typename = "scsi",
11f610ed
SG
704 .if_type = IF_TYPE_SCSI,
705 .max_devs = CONFIG_SYS_SCSI_MAX_DEVICE,
706 .desc = scsi_dev_desc,
707};
535556b2 708#endif