1 // SPDX-License-Identifier: GPL-2.0+
3 * (C) Copyright 2007-2008 Semihalf
5 * Written by: Rafal Jaworowski <raj@semihalf.com>
10 #include <api_public.h>
12 #if defined(CONFIG_CMD_USB) && defined(CONFIG_USB_STORAGE)
20 #define debugf(fmt, args...) do { printf("%s(): ", __func__); printf(fmt, ##args); } while (0)
22 #define debugf(fmt, args...)
25 #define errf(fmt, args...) do { printf("ERROR @ %s(): ", __func__); printf(fmt, ##args); } while (0)
39 int type
; /* "external" type: DT_STOR_{IDE,USB,etc} */
43 static struct stor_spec specs
[ENUM_MAX
] = { { 0, 0, 0, 0, NULL
}, };
45 #ifndef CONFIG_SYS_MMC_MAX_DEVICE
46 #define CONFIG_SYS_MMC_MAX_DEVICE 1
49 void dev_stor_init(void)
51 #if defined(CONFIG_IDE)
52 specs
[ENUM_IDE
].max_dev
= CONFIG_SYS_IDE_MAXDEVICE
;
53 specs
[ENUM_IDE
].enum_started
= 0;
54 specs
[ENUM_IDE
].enum_ended
= 0;
55 specs
[ENUM_IDE
].type
= DEV_TYP_STOR
| DT_STOR_IDE
;
56 specs
[ENUM_IDE
].name
= "ide";
58 #if defined(CONFIG_CMD_MMC)
59 specs
[ENUM_MMC
].max_dev
= CONFIG_SYS_MMC_MAX_DEVICE
;
60 specs
[ENUM_MMC
].enum_started
= 0;
61 specs
[ENUM_MMC
].enum_ended
= 0;
62 specs
[ENUM_MMC
].type
= DEV_TYP_STOR
| DT_STOR_MMC
;
63 specs
[ENUM_MMC
].name
= "mmc";
65 #if defined(CONFIG_SATA)
66 specs
[ENUM_SATA
].max_dev
= CONFIG_SYS_SATA_MAX_DEVICE
;
67 specs
[ENUM_SATA
].enum_started
= 0;
68 specs
[ENUM_SATA
].enum_ended
= 0;
69 specs
[ENUM_SATA
].type
= DEV_TYP_STOR
| DT_STOR_SATA
;
70 specs
[ENUM_SATA
].name
= "sata";
72 #if defined(CONFIG_SCSI)
73 specs
[ENUM_SCSI
].max_dev
= CONFIG_SYS_SCSI_MAX_DEVICE
;
74 specs
[ENUM_SCSI
].enum_started
= 0;
75 specs
[ENUM_SCSI
].enum_ended
= 0;
76 specs
[ENUM_SCSI
].type
= DEV_TYP_STOR
| DT_STOR_SCSI
;
77 specs
[ENUM_SCSI
].name
= "scsi";
79 #if defined(CONFIG_CMD_USB) && defined(CONFIG_USB_STORAGE)
80 specs
[ENUM_USB
].max_dev
= USB_MAX_STOR_DEV
;
81 specs
[ENUM_USB
].enum_started
= 0;
82 specs
[ENUM_USB
].enum_ended
= 0;
83 specs
[ENUM_USB
].type
= DEV_TYP_STOR
| DT_STOR_USB
;
84 specs
[ENUM_USB
].name
= "usb";
89 * Finds next available device in the storage group
91 * type: storage group type - ENUM_IDE, ENUM_SCSI etc.
93 * more: returns 0/1 depending if there are more devices in this group
94 * available (for future iterations)
96 * returns: 0/1 depending if device found in this iteration
98 static int dev_stor_get(int type
, int *more
, struct device_info
*di
)
104 /* Wasn't configured for this type, return 0 directly */
105 if (specs
[type
].name
== NULL
)
108 if (di
->cookie
!= NULL
) {
109 /* Find the last device we've returned */
110 for (i
= 0; i
< specs
[type
].max_dev
; i
++) {
112 (void *)blk_get_dev(specs
[type
].name
, i
)) {
119 for (; i
< specs
[type
].max_dev
; i
++) {
120 di
->cookie
= (void *)blk_get_dev(specs
[type
].name
, i
);
122 if (di
->cookie
!= NULL
) {
128 if (i
== specs
[type
].max_dev
)
134 di
->type
= specs
[type
].type
;
136 dd
= (struct blk_desc
*)di
->cookie
;
137 if (dd
->type
== DEV_TYPE_UNKNOWN
) {
138 debugf("device instance exists, but is not active..");
141 di
->di_stor
.block_count
= dd
->lba
;
142 di
->di_stor
.block_size
= dd
->blksz
;
152 /* returns: ENUM_IDE, ENUM_USB etc. based on struct blk_desc */
154 static int dev_stor_type(struct blk_desc
*dd
)
158 for (i
= ENUM_IDE
; i
< ENUM_MAX
; i
++)
159 for (j
= 0; j
< specs
[i
].max_dev
; j
++)
160 if (dd
== blk_get_dev(specs
[i
].name
, j
))
167 /* returns: 0/1 whether cookie points to some device in this group */
169 static int dev_is_stor(int type
, struct device_info
*di
)
171 return (dev_stor_type(di
->cookie
) == type
) ? 1 : 0;
175 static int dev_enum_stor(int type
, struct device_info
*di
)
177 int found
= 0, more
= 0;
179 debugf("called, type %d\n", type
);
182 * Formulae for enumerating storage devices:
183 * 1. if cookie (hint from previous enum call) is NULL we start again
184 * with enumeration, so return the first available device, done.
186 * 2. if cookie is not NULL, check if it identifies some device in
189 * 2a. if cookie is a storage device from our group (IDE, USB etc.),
190 * return next available (if exists) in this group
192 * 2b. if it isn't device from our group, check if such devices were
193 * ever enumerated before:
194 * - if not, return the first available device from this group
198 if (di
->cookie
== NULL
) {
199 debugf("group%d - enum restart\n", type
);
202 * 1. Enumeration (re-)started: take the first available
205 found
= dev_stor_get(type
, &more
, di
);
206 specs
[type
].enum_started
= 1;
208 } else if (dev_is_stor(type
, di
)) {
209 debugf("group%d - enum continued for the next device\n", type
);
211 if (specs
[type
].enum_ended
) {
212 debugf("group%d - nothing more to enum!\n", type
);
216 /* 2a. Attempt to take a next available device in the group */
217 found
= dev_stor_get(type
, &more
, di
);
220 if (specs
[type
].enum_ended
) {
221 debugf("group %d - already enumerated, skipping\n", type
);
225 debugf("group%d - first time enum\n", type
);
227 if (specs
[type
].enum_started
== 0) {
229 * 2b. If enumerating devices in this group did not
230 * happen before, it means the cookie pointed to a
231 * device from some other group (another storage
232 * group, or network); in this case try to take the
233 * first available device from our group
235 specs
[type
].enum_started
= 1;
238 * Attempt to take the first device in this group:
239 *'first element' flag is set
241 found
= dev_stor_get(type
, &more
, di
);
244 errf("group%d - out of order iteration\n", type
);
251 * If there are no more devices in this group, consider its
252 * enumeration finished
254 specs
[type
].enum_ended
= (!more
) ? 1 : 0;
257 debugf("device found, returning cookie 0x%08x\n",
258 (u_int32_t
)di
->cookie
);
260 debugf("no device found\n");
265 void dev_enum_reset(void)
269 for (i
= 0; i
< ENUM_MAX
; i
++) {
270 specs
[i
].enum_started
= 0;
271 specs
[i
].enum_ended
= 0;
275 int dev_enum_storage(struct device_info
*di
)
279 /* check: ide, usb, scsi, mmc */
280 for (i
= ENUM_IDE
; i
< ENUM_MAX
; i
++) {
281 if (dev_enum_stor(i
, di
))
288 static int dev_stor_is_valid(int type
, struct blk_desc
*dd
)
292 for (i
= 0; i
< specs
[type
].max_dev
; i
++)
293 if (dd
== blk_get_dev(specs
[type
].name
, i
))
294 if (dd
->type
!= DEV_TYPE_UNKNOWN
)
301 int dev_open_stor(void *cookie
)
303 int type
= dev_stor_type(cookie
);
305 if (type
== ENUM_MAX
)
308 if (dev_stor_is_valid(type
, (struct blk_desc
*)cookie
))
315 int dev_close_stor(void *cookie
)
318 * Not much to do as we actually do not alter storage devices upon
325 lbasize_t
dev_read_stor(void *cookie
, void *buf
, lbasize_t len
, lbastart_t start
)
328 struct blk_desc
*dd
= (struct blk_desc
*)cookie
;
330 if ((type
= dev_stor_type(dd
)) == ENUM_MAX
)
333 if (!dev_stor_is_valid(type
, dd
))
337 return blk_dread(dd
, start
, len
, buf
);
339 if ((dd
->block_read
) == NULL
) {
340 debugf("no block_read() for device 0x%08x\n", cookie
);
344 return dd
->block_read(dd
, start
, len
, buf
);
345 #endif /* defined(CONFIG_BLK) */