blob: 48cb2a2818bc8dff58b864db86fabcbbf88a548d [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Simon Glass11f610e2016-05-01 11:36:09 -06002/*
3 * (C) Copyright 2001
4 * Denis Peter, MPL AG Switzerland
Simon Glass11f610e2016-05-01 11:36:09 -06005 */
6
7#include <common.h>
Simon Glass535556b2016-05-01 11:36:24 -06008#include <dm.h>
Simon Glass168068f2019-08-01 09:46:47 -06009#include <env.h>
Simon Glass11f610e2016-05-01 11:36:09 -060010#include <pci.h>
11#include <scsi.h>
Michal Simeke8a016b2016-09-08 15:06:45 +020012#include <dm/device-internal.h>
13#include <dm/uclass-internal.h>
Simon Glass11f610e2016-05-01 11:36:09 -060014
Michal Simeke8a016b2016-09-08 15:06:45 +020015#if !defined(CONFIG_DM_SCSI)
Simon Glass099c2392017-06-14 21:28:35 -060016# ifdef CONFIG_SCSI_DEV_LIST
17# define SCSI_DEV_LIST CONFIG_SCSI_DEV_LIST
18# else
19# ifdef CONFIG_SATA_ULI5288
Simon Glass11f610e2016-05-01 11:36:09 -060020
Simon Glass099c2392017-06-14 21:28:35 -060021# define SCSI_VEND_ID 0x10b9
22# define SCSI_DEV_ID 0x5288
Simon Glass11f610e2016-05-01 11:36:09 -060023
Simon Glass099c2392017-06-14 21:28:35 -060024# 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
Michal Simeke8a016b2016-09-08 15:06:45 +020029#endif
Simon Glass11f610e2016-05-01 11:36:09 -060030
Simon Glass7337fcd2017-06-14 21:28:47 -060031#if defined(CONFIG_PCI) && !defined(CONFIG_SCSI_AHCI_PLAT) && \
32 !defined(CONFIG_DM_SCSI)
Simon Glass11f610e2016-05-01 11:36:09 -060033const struct pci_device_id scsi_device_list[] = { SCSI_DEV_LIST };
34#endif
Simon Glassb9560ad2017-06-14 21:28:30 -060035static struct scsi_cmd tempccb; /* temporary scsi command buffer */
Simon Glass11f610e2016-05-01 11:36:09 -060036
37static unsigned char tempbuff[512]; /* temporary data buffer */
38
Michal Simeke8a016b2016-09-08 15:06:45 +020039#if !defined(CONFIG_DM_SCSI)
Simon Glass11f610e2016-05-01 11:36:09 -060040static 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];
Michal Simeke8a016b2016-09-08 15:06:45 +020045#endif
Simon Glass11f610e2016-05-01 11:36:09 -060046
47/* almost the maximum amount of the scsi_ext command.. */
48#define SCSI_MAX_READ_BLK 0xFFFF
49#define SCSI_LBA48_READ 0xFFFFFFF
50
Simon Glassb9560ad2017-06-14 21:28:30 -060051static void scsi_print_error(struct scsi_cmd *pccb)
Simon Glassa6fb1852017-06-14 21:28:23 -060052{
53 /* Dummy function that could print an error for debugging */
54}
55
Simon Glass11f610e2016-05-01 11:36:09 -060056#ifdef CONFIG_SYS_64BIT_LBA
Simon Glassb9560ad2017-06-14 21:28:30 -060057void scsi_setup_read16(struct scsi_cmd *pccb, lbaint_t start,
58 unsigned long blocks)
Simon Glass11f610e2016-05-01 11:36:09 -060059{
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
Simon Glassb9560ad2017-06-14 21:28:30 -060086static void scsi_setup_read_ext(struct scsi_cmd *pccb, lbaint_t start,
Michal Simek545a2842016-11-30 11:53:43 +010087 unsigned short blocks)
Simon Glass11f610e2016-05-01 11:36:09 -060088{
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
Simon Glassb9560ad2017-06-14 21:28:30 -0600107static void scsi_setup_write_ext(struct scsi_cmd *pccb, lbaint_t start,
Michal Simek545a2842016-11-30 11:53:43 +0100108 unsigned short blocks)
Simon Glass11f610e2016-05-01 11:36:09 -0600109{
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
Simon Glassb9560ad2017-06-14 21:28:30 -0600129static void scsi_setup_inquiry(struct scsi_cmd *pccb)
Simon Glass11f610e2016-05-01 11:36:09 -0600130{
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
Simon Glass535556b2016-05-01 11:36:24 -0600144#ifdef CONFIG_BLK
145static ulong scsi_read(struct udevice *dev, lbaint_t blknr, lbaint_t blkcnt,
146 void *buffer)
147#else
Simon Glass11f610e2016-05-01 11:36:09 -0600148static ulong scsi_read(struct blk_desc *block_dev, lbaint_t blknr,
149 lbaint_t blkcnt, void *buffer)
Simon Glass535556b2016-05-01 11:36:24 -0600150#endif
Simon Glass11f610e2016-05-01 11:36:09 -0600151{
Simon Glass535556b2016-05-01 11:36:24 -0600152#ifdef CONFIG_BLK
153 struct blk_desc *block_dev = dev_get_uclass_platdata(dev);
Simon Glass4682c8a2017-06-14 21:28:40 -0600154 struct udevice *bdev = dev->parent;
155#else
156 struct udevice *bdev = NULL;
Simon Glass535556b2016-05-01 11:36:24 -0600157#endif
Simon Glass11f610e2016-05-01 11:36:09 -0600158 lbaint_t start, blks;
159 uintptr_t buf_addr;
160 unsigned short smallblks = 0;
Simon Glassb9560ad2017-06-14 21:28:30 -0600161 struct scsi_cmd *pccb = (struct scsi_cmd *)&tempccb;
Simon Glass11f610e2016-05-01 11:36:09 -0600162
163 /* Setup device */
Michal Simekcdb93b22016-11-18 16:22:42 +0100164 pccb->target = block_dev->target;
165 pccb->lun = block_dev->lun;
Simon Glass11f610e2016-05-01 11:36:09 -0600166 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",
Michal Simekcdb93b22016-11-18 16:22:42 +0100171 block_dev->devnum, start, blks, (unsigned long)buffer);
Simon Glass11f610e2016-05-01 11:36:09 -0600172 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);
Michal Simekcdb93b22016-11-18 16:22:42 +0100178 pccb->datalen = block_dev->blksz * blocks;
Simon Glass11f610e2016-05-01 11:36:09 -0600179 scsi_setup_read16(pccb, start, blocks);
180 start += blocks;
181 blks -= blocks;
182 } else
183#endif
184 if (blks > SCSI_MAX_READ_BLK) {
Michal Simekcdb93b22016-11-18 16:22:42 +0100185 pccb->datalen = block_dev->blksz *
Simon Glass11f610e2016-05-01 11:36:09 -0600186 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 {
Michal Simekcdb93b22016-11-18 16:22:42 +0100192 pccb->datalen = block_dev->blksz * blks;
Simon Glass11f610e2016-05-01 11:36:09 -0600193 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
Masahiro Yamadadee37fc2018-08-06 20:47:40 +0900199 ", blccnt %x buffer %lX\n",
Simon Glass11f610e2016-05-01 11:36:09 -0600200 start, smallblks, buf_addr);
Simon Glass4682c8a2017-06-14 21:28:40 -0600201 if (scsi_exec(bdev, pccb)) {
Simon Glass11f610e2016-05-01 11:36:09 -0600202 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
Masahiro Yamadadee37fc2018-08-06 20:47:40 +0900209 ", blccnt %x buffer %lX\n", start, smallblks, buf_addr);
Simon Glass11f610e2016-05-01 11:36:09 -0600210 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
Simon Glass535556b2016-05-01 11:36:24 -0600220#ifdef CONFIG_BLK
221static ulong scsi_write(struct udevice *dev, lbaint_t blknr, lbaint_t blkcnt,
222 const void *buffer)
223#else
Simon Glass11f610e2016-05-01 11:36:09 -0600224static ulong scsi_write(struct blk_desc *block_dev, lbaint_t blknr,
225 lbaint_t blkcnt, const void *buffer)
Simon Glass535556b2016-05-01 11:36:24 -0600226#endif
Simon Glass11f610e2016-05-01 11:36:09 -0600227{
Simon Glass535556b2016-05-01 11:36:24 -0600228#ifdef CONFIG_BLK
229 struct blk_desc *block_dev = dev_get_uclass_platdata(dev);
Simon Glass4682c8a2017-06-14 21:28:40 -0600230 struct udevice *bdev = dev->parent;
231#else
232 struct udevice *bdev = NULL;
Simon Glass535556b2016-05-01 11:36:24 -0600233#endif
Simon Glass11f610e2016-05-01 11:36:09 -0600234 lbaint_t start, blks;
235 uintptr_t buf_addr;
236 unsigned short smallblks;
Simon Glassb9560ad2017-06-14 21:28:30 -0600237 struct scsi_cmd *pccb = (struct scsi_cmd *)&tempccb;
Simon Glass11f610e2016-05-01 11:36:09 -0600238
Simon Glass11f610e2016-05-01 11:36:09 -0600239 /* Setup device */
Michal Simekcdb93b22016-11-18 16:22:42 +0100240 pccb->target = block_dev->target;
241 pccb->lun = block_dev->lun;
Simon Glass11f610e2016-05-01 11:36:09 -0600242 buf_addr = (unsigned long)buffer;
243 start = blknr;
244 blks = blkcnt;
245 debug("\n%s: dev %d startblk " LBAF ", blccnt " LBAF " buffer %lx\n",
Michal Simekcdb93b22016-11-18 16:22:42 +0100246 __func__, block_dev->devnum, start, blks, (unsigned long)buffer);
Simon Glass11f610e2016-05-01 11:36:09 -0600247 do {
248 pccb->pdata = (unsigned char *)buf_addr;
249 if (blks > SCSI_MAX_WRITE_BLK) {
Michal Simekcdb93b22016-11-18 16:22:42 +0100250 pccb->datalen = (block_dev->blksz *
Simon Glass11f610e2016-05-01 11:36:09 -0600251 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 {
Michal Simekcdb93b22016-11-18 16:22:42 +0100257 pccb->datalen = block_dev->blksz * blks;
Simon Glass11f610e2016-05-01 11:36:09 -0600258 smallblks = (unsigned short)blks;
259 scsi_setup_write_ext(pccb, start, smallblks);
260 start += blks;
261 blks = 0;
262 }
Masahiro Yamadadee37fc2018-08-06 20:47:40 +0900263 debug("%s: startblk " LBAF ", blccnt %x buffer %lx\n",
Simon Glass11f610e2016-05-01 11:36:09 -0600264 __func__, start, smallblks, buf_addr);
Simon Glass4682c8a2017-06-14 21:28:40 -0600265 if (scsi_exec(bdev, pccb)) {
Simon Glass11f610e2016-05-01 11:36:09 -0600266 scsi_print_error(pccb);
267 blkcnt -= blks;
268 break;
269 }
270 buf_addr += pccb->datalen;
271 } while (blks != 0);
Masahiro Yamadadee37fc2018-08-06 20:47:40 +0900272 debug("%s: end startblk " LBAF ", blccnt %x buffer %lX\n",
Simon Glass11f610e2016-05-01 11:36:09 -0600273 __func__, start, smallblks, buf_addr);
274 return blkcnt;
275}
276
Simon Glass7337fcd2017-06-14 21:28:47 -0600277#if defined(CONFIG_PCI) && !defined(CONFIG_SCSI_AHCI_PLAT) && \
278 !defined(CONFIG_DM_SCSI)
Simon Glass11f610e2016-05-01 11:36:09 -0600279void 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);
Simon Glass8eab1a52017-06-14 21:28:41 -0600330 scsi_scan(true);
Simon Glass11f610e2016-05-01 11:36:09 -0600331 bootstage_accum(BOOTSTAGE_ID_ACCUM_SCSI);
332}
333#endif
334
Simon Glass11f610e2016-05-01 11:36:09 -0600335/* copy src to dest, skipping leading and trailing blanks
336 * and null terminate the string
337 */
Michal Simek545a2842016-11-30 11:53:43 +0100338static void scsi_ident_cpy(unsigned char *dest, unsigned char *src,
339 unsigned int len)
Simon Glass11f610e2016-05-01 11:36:09 -0600340{
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
Simon Glass4682c8a2017-06-14 21:28:40 -0600360static int scsi_read_capacity(struct udevice *dev, struct scsi_cmd *pccb,
361 lbaint_t *capacity, unsigned long *blksz)
Simon Glass11f610e2016-05-01 11:36:09 -0600362{
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;
Simon Glassf6580ef2017-06-14 21:28:44 -0600372 if (scsi_exec(dev, pccb))
Simon Glass11f610e2016-05-01 11:36:09 -0600373 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;
Simon Glassf6580ef2017-06-14 21:28:44 -0600397 if (scsi_exec(dev, pccb))
Simon Glass11f610e2016-05-01 11:36:09 -0600398 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 */
Simon Glassb9560ad2017-06-14 21:28:30 -0600425static void scsi_setup_test_unit_ready(struct scsi_cmd *pccb)
Simon Glass11f610e2016-05-01 11:36:09 -0600426{
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
Michal Simek0b3a58e2016-11-30 12:50:58 +0100437/**
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)
Michal Simek92ca4762016-11-18 15:27:00 +0100443{
444 dev_desc->target = 0xff;
445 dev_desc->lun = 0xff;
Michal Simek92ca4762016-11-18 15:27:00 +0100446 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;
Simon Glassc4d660d2017-07-04 13:31:19 -0600453#if !CONFIG_IS_ENABLED(BLK)
Michal Simek92ca4762016-11-18 15:27:00 +0100454 dev_desc->block_read = scsi_read;
455 dev_desc->block_write = scsi_write;
456#endif
457}
458
Michal Simeke8a016b2016-09-08 15:06:45 +0200459#if !defined(CONFIG_DM_SCSI)
Michal Simek0b3a58e2016-11-30 12:50:58 +0100460/**
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}
Michal Simeke8a016b2016-09-08 15:06:45 +0200476#endif
Michal Simekbccfd9e2016-11-18 16:14:24 +0100477
Michal Simek570712f2016-11-18 15:42:13 +0100478/**
479 * scsi_detect_dev - Detect scsi device
480 *
Michal Simekbccfd9e2016-11-18 16:14:24 +0100481 * @target: target id
Jean-Jacques Hiblote39cecf2017-04-07 13:42:06 +0200482 * @lun: target lun
Michal Simek570712f2016-11-18 15:42:13 +0100483 * @dev_desc: block device description
Michal Simek570712f2016-11-18 15:42:13 +0100484 *
485 * The scsi_detect_dev detects and fills a dev_desc structure when the device is
Jean-Jacques Hiblote39cecf2017-04-07 13:42:06 +0200486 * detected.
Michal Simek570712f2016-11-18 15:42:13 +0100487 *
488 * Return: 0 on success, error value otherwise
489 */
Simon Glass4682c8a2017-06-14 21:28:40 -0600490static int scsi_detect_dev(struct udevice *dev, int target, int lun,
491 struct blk_desc *dev_desc)
Michal Simek570712f2016-11-18 15:42:13 +0100492{
493 unsigned char perq, modi;
494 lbaint_t capacity;
495 unsigned long blksz;
Simon Glassb9560ad2017-06-14 21:28:30 -0600496 struct scsi_cmd *pccb = (struct scsi_cmd *)&tempccb;
Michal Simek570712f2016-11-18 15:42:13 +0100497
Michal Simekbccfd9e2016-11-18 16:14:24 +0100498 pccb->target = target;
Jean-Jacques Hiblote39cecf2017-04-07 13:42:06 +0200499 pccb->lun = lun;
Michal Simek570712f2016-11-18 15:42:13 +0100500 pccb->pdata = (unsigned char *)&tempbuff;
501 pccb->datalen = 512;
502 scsi_setup_inquiry(pccb);
Simon Glassf6580ef2017-06-14 21:28:44 -0600503 if (scsi_exec(dev, pccb)) {
Michal Simek570712f2016-11-18 15:42:13 +0100504 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);
Simon Glassf6580ef2017-06-14 21:28:44 -0600534 if (scsi_exec(dev, pccb)) {
Michal Simek570712f2016-11-18 15:42:13 +0100535 if (dev_desc->removable) {
536 dev_desc->type = perq;
537 goto removable;
538 }
539 scsi_print_error(pccb);
540 return -EINVAL;
541 }
Simon Glass4682c8a2017-06-14 21:28:40 -0600542 if (scsi_read_capacity(dev, pccb, &capacity, &blksz)) {
Michal Simek570712f2016-11-18 15:42:13 +0100543 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;
Michal Simek570712f2016-11-18 15:42:13 +0100550removable:
551 return 0;
552}
553
Simon Glass11f610e2016-05-01 11:36:09 -0600554/*
555 * (re)-scan the scsi bus and reports scsi device info
556 * to the user if mode = 1
557 */
Michal Simeke8a016b2016-09-08 15:06:45 +0200558#if defined(CONFIG_DM_SCSI)
Simon Glass8eab1a52017-06-14 21:28:41 -0600559static int do_scsi_scan_one(struct udevice *dev, int id, int lun, bool verbose)
Jean-Jacques Hiblotd52063b2017-04-24 11:51:26 +0200560{
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);
Simon Glass4682c8a2017-06-14 21:28:40 -0600572 if (scsi_detect_dev(dev, id, lun, &bd))
Jean-Jacques Hiblotd52063b2017-04-24 11:51:26 +0200573 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,
Jean-Jacques Hiblot5fe77022017-06-09 16:45:18 +0200582 bd.blksz, bd.lba, &bdev);
Jean-Jacques Hiblotd52063b2017-04-24 11:51:26 +0200583 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));
Jean-Jacques Hiblotd52063b2017-04-24 11:51:26 +0200596
Simon Glass8eab1a52017-06-14 21:28:41 -0600597 if (verbose) {
Heinrich Schuchardt90037d42019-02-05 18:06:24 +0100598 printf(" Device %d: ", bdesc->devnum);
Jean-Jacques Hiblotd52063b2017-04-24 11:51:26 +0200599 dev_print(bdesc);
600 }
601 return 0;
602}
603
Simon Glass5c561762017-06-14 21:28:45 -0600604int 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
Simon Glass8eab1a52017-06-14 21:28:41 -0600626int scsi_scan(bool verbose)
Michal Simeke8a016b2016-09-08 15:06:45 +0200627{
Michal Simeke8a016b2016-09-08 15:06:45 +0200628 struct uclass *uc;
629 struct udevice *dev; /* SCSI controller */
630 int ret;
631
Simon Glass8eab1a52017-06-14 21:28:41 -0600632 if (verbose)
Michal Simeke8a016b2016-09-08 15:06:45 +0200633 printf("scanning bus for devices...\n");
634
Michal Simekf8f41ae2017-01-02 09:40:09 +0100635 blk_unbind_all(IF_TYPE_SCSI);
636
Michal Simeke8a016b2016-09-08 15:06:45 +0200637 ret = uclass_get(UCLASS_SCSI, &uc);
638 if (ret)
639 return ret;
640
641 uclass_foreach_dev(dev, uc) {
Simon Glass5c561762017-06-14 21:28:45 -0600642 ret = scsi_scan_dev(dev, verbose);
Michal Simeke8a016b2016-09-08 15:06:45 +0200643 if (ret)
644 return ret;
Michal Simeke8a016b2016-09-08 15:06:45 +0200645 }
646
647 return 0;
648}
649#else
Simon Glass8eab1a52017-06-14 21:28:41 -0600650int scsi_scan(bool verbose)
Simon Glass11f610e2016-05-01 11:36:09 -0600651{
Michal Simek570712f2016-11-18 15:42:13 +0100652 unsigned char i, lun;
653 int ret;
Simon Glass11f610e2016-05-01 11:36:09 -0600654
Simon Glass8eab1a52017-06-14 21:28:41 -0600655 if (verbose)
Simon Glass11f610e2016-05-01 11:36:09 -0600656 printf("scanning bus for devices...\n");
Michal Simek92ca4762016-11-18 15:27:00 +0100657 for (i = 0; i < CONFIG_SYS_SCSI_MAX_DEVICE; i++)
658 scsi_init_dev_desc(&scsi_dev_desc[i], i);
659
Simon Glass11f610e2016-05-01 11:36:09 -0600660 scsi_max_devs = 0;
661 for (i = 0; i < CONFIG_SYS_SCSI_MAX_SCSI_ID; i++) {
Simon Glass11f610e2016-05-01 11:36:09 -0600662 for (lun = 0; lun < CONFIG_SYS_SCSI_MAX_LUN; lun++) {
Heinrich Schuchardt90037d42019-02-05 18:06:24 +0100663 struct blk_desc *bdesc = &scsi_dev_desc[scsi_max_devs];
664
665 ret = scsi_detect_dev(NULL, i, lun, bdesc);
Michal Simek570712f2016-11-18 15:42:13 +0100666 if (ret)
Simon Glass11f610e2016-05-01 11:36:09 -0600667 continue;
Heinrich Schuchardt90037d42019-02-05 18:06:24 +0100668 part_init(bdesc);
Simon Glass11f610e2016-05-01 11:36:09 -0600669
Simon Glass8eab1a52017-06-14 21:28:41 -0600670 if (verbose) {
Heinrich Schuchardt90037d42019-02-05 18:06:24 +0100671 printf(" Device %d: ", bdesc->devnum);
672 dev_print(bdesc);
Simon Glass8eab1a52017-06-14 21:28:41 -0600673 }
Simon Glass11f610e2016-05-01 11:36:09 -0600674 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
Simon Glass018f5302017-08-03 12:22:10 -0600684 env_set_ulong("scsidevs", scsi_max_devs);
Simon Glass11f610e2016-05-01 11:36:09 -0600685#endif
Michal Simekc002e392016-11-30 12:12:31 +0100686 return 0;
Simon Glass11f610e2016-05-01 11:36:09 -0600687}
Michal Simeke8a016b2016-09-08 15:06:45 +0200688#endif
Simon Glass11f610e2016-05-01 11:36:09 -0600689
Simon Glass535556b2016-05-01 11:36:24 -0600690#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
Simon Glass11f610e2016-05-01 11:36:09 -0600702U_BOOT_LEGACY_BLK(scsi) = {
Ed Swarthout69c125f2016-06-01 08:11:24 -0500703 .if_typename = "scsi",
Simon Glass11f610e2016-05-01 11:36:09 -0600704 .if_type = IF_TYPE_SCSI,
705 .max_devs = CONFIG_SYS_SCSI_MAX_DEVICE,
706 .desc = scsi_dev_desc,
707};
Simon Glass535556b2016-05-01 11:36:24 -0600708#endif