2 * (C) Copyright 2007-2008 Semihalf
4 * Written by: Rafal Jaworowski <raj@semihalf.com>
6 * See file CREDITS for list of people who contributed to this
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License as
11 * published by the Free Software Foundation; either version 2 of
12 * the License, or (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
28 #if defined(CONFIG_API)
31 #include <api_public.h>
33 #if defined(CONFIG_CMD_USB) && defined(CONFIG_USB_STORAGE)
41 #define debugf(fmt, args...) do { printf("%s(): ", __func__); printf(fmt, ##args); } while (0)
43 #define debugf(fmt, args...)
46 #define errf(fmt, args...) do { printf("ERROR @ %s(): ", __func__); printf(fmt, ##args); } while (0)
60 int type
; /* "external" type: DT_STOR_{IDE,USB,etc} */
64 static struct stor_spec specs
[ENUM_MAX
] = { { 0, 0, 0, 0, "" }, };
67 void dev_stor_init(void)
69 #if defined(CONFIG_CMD_IDE)
70 specs
[ENUM_IDE
].max_dev
= CONFIG_SYS_IDE_MAXDEVICE
;
71 specs
[ENUM_IDE
].enum_started
= 0;
72 specs
[ENUM_IDE
].enum_ended
= 0;
73 specs
[ENUM_IDE
].type
= DEV_TYP_STOR
| DT_STOR_IDE
;
74 specs
[ENUM_IDE
].name
= "ide";
76 #if defined(CONFIG_CMD_MMC)
77 specs
[ENUM_MMC
].max_dev
= CONFIG_SYS_MMC_MAX_DEVICE
;
78 specs
[ENUM_MMC
].enum_started
= 0;
79 specs
[ENUM_MMC
].enum_ended
= 0;
80 specs
[ENUM_MMC
].type
= DEV_TYP_STOR
| DT_STOR_MMC
;
81 specs
[ENUM_MMC
].name
= "mmc";
83 #if defined(CONFIG_CMD_SATA)
84 specs
[ENUM_SATA
].max_dev
= CONFIG_SYS_SATA_MAX_DEVICE
;
85 specs
[ENUM_SATA
].enum_started
= 0;
86 specs
[ENUM_SATA
].enum_ended
= 0;
87 specs
[ENUM_SATA
].type
= DEV_TYP_STOR
| DT_STOR_SATA
;
88 specs
[ENUM_SATA
].name
= "sata";
90 #if defined(CONFIG_CMD_SCSI)
91 specs
[ENUM_SCSI
].max_dev
= CONFIG_SYS_SCSI_MAX_DEVICE
;
92 specs
[ENUM_SCSI
].enum_started
= 0;
93 specs
[ENUM_SCSI
].enum_ended
= 0;
94 specs
[ENUM_SCSI
].type
= DEV_TYP_STOR
| DT_STOR_SCSI
;
95 specs
[ENUM_SCSI
].name
= "scsi";
97 #if defined(CONFIG_CMD_USB) && defined(CONFIG_USB_STORAGE)
98 specs
[ENUM_USB
].max_dev
= USB_MAX_STOR_DEV
;
99 specs
[ENUM_USB
].enum_started
= 0;
100 specs
[ENUM_USB
].enum_ended
= 0;
101 specs
[ENUM_USB
].type
= DEV_TYP_STOR
| DT_STOR_USB
;
102 specs
[ENUM_USB
].name
= "usb";
107 * Finds next available device in the storage group
109 * type: storage group type - ENUM_IDE, ENUM_SCSI etc.
111 * first: if 1 the first device in the storage group is returned (if
112 * exists), if 0 the next available device is searched
114 * more: returns 0/1 depending if there are more devices in this group
115 * available (for future iterations)
117 * returns: 0/1 depending if device found in this iteration
119 static int dev_stor_get(int type
, int first
, int *more
, struct device_info
*di
)
126 block_dev_desc_t
*dd
;
129 di
->cookie
= (void *)get_dev(specs
[type
].name
, 0);
130 if (di
->cookie
== NULL
)
136 for (i
= 0; i
< specs
[type
].max_dev
; i
++)
137 if (di
->cookie
== (void *)get_dev(specs
[type
].name
, i
)) {
138 /* previous cookie found -- advance to the
139 * next device, if possible */
141 if (++i
>= specs
[type
].max_dev
) {
142 /* out of range, no more to enum */
147 di
->cookie
= (void *)get_dev(specs
[type
].name
, i
);
148 if (di
->cookie
== NULL
)
153 /* provide hint if there are more devices in
154 * this group to enumerate */
155 if ((i
+ 1) < specs
[type
].max_dev
)
163 di
->type
= specs
[type
].type
;
165 if (di
->cookie
!= NULL
) {
166 dd
= (block_dev_desc_t
*)di
->cookie
;
167 if (dd
->type
== DEV_TYPE_UNKNOWN
) {
168 debugf("device instance exists, but is not active..");
171 di
->di_stor
.block_count
= dd
->lba
;
172 di
->di_stor
.block_size
= dd
->blksz
;
184 * returns: ENUM_IDE, ENUM_USB etc. based on block_dev_desc_t
186 static int dev_stor_type(block_dev_desc_t
*dd
)
190 for (i
= ENUM_IDE
; i
< ENUM_MAX
; i
++)
191 for (j
= 0; j
< specs
[i
].max_dev
; j
++)
192 if (dd
== get_dev(specs
[i
].name
, j
))
200 * returns: 0/1 whether cookie points to some device in this group
202 static int dev_is_stor(int type
, struct device_info
*di
)
204 return (dev_stor_type(di
->cookie
) == type
) ? 1 : 0;
208 static int dev_enum_stor(int type
, struct device_info
*di
)
210 int found
= 0, more
= 0;
212 debugf("called, type %d\n", type
);
215 * Formulae for enumerating storage devices:
216 * 1. if cookie (hint from previous enum call) is NULL we start again
217 * with enumeration, so return the first available device, done.
219 * 2. if cookie is not NULL, check if it identifies some device in
222 * 2a. if cookie is a storage device from our group (IDE, USB etc.),
223 * return next available (if exists) in this group
225 * 2b. if it isn't device from our group, check if such devices were
226 * ever enumerated before:
227 * - if not, return the first available device from this group
231 if (di
->cookie
== NULL
) {
233 debugf("group%d - enum restart\n", type
);
236 * 1. Enumeration (re-)started: take the first available
239 found
= dev_stor_get(type
, 1, &more
, di
);
240 specs
[type
].enum_started
= 1;
242 } else if (dev_is_stor(type
, di
)) {
244 debugf("group%d - enum continued for the next device\n", type
);
246 if (specs
[type
].enum_ended
) {
247 debugf("group%d - nothing more to enum!\n", type
);
251 /* 2a. Attempt to take a next available device in the group */
252 found
= dev_stor_get(type
, 0, &more
, di
);
256 if (specs
[type
].enum_ended
) {
257 debugf("group %d - already enumerated, skipping\n", type
);
261 debugf("group%d - first time enum\n", type
);
263 if (specs
[type
].enum_started
== 0) {
265 * 2b. If enumerating devices in this group did not
266 * happen before, it means the cookie pointed to a
267 * device frome some other group (another storage
268 * group, or network); in this case try to take the
269 * first available device from our group
271 specs
[type
].enum_started
= 1;
274 * Attempt to take the first device in this group:
275 *'first element' flag is set
277 found
= dev_stor_get(type
, 1, &more
, di
);
280 errf("group%d - out of order iteration\n", type
);
287 * If there are no more devices in this group, consider its
288 * enumeration finished
290 specs
[type
].enum_ended
= (!more
) ? 1 : 0;
293 debugf("device found, returning cookie 0x%08x\n",
294 (u_int32_t
)di
->cookie
);
296 debugf("no device found\n");
301 void dev_enum_reset(void)
305 for (i
= 0; i
< ENUM_MAX
; i
++) {
306 specs
[i
].enum_started
= 0;
307 specs
[i
].enum_ended
= 0;
311 int dev_enum_storage(struct device_info
*di
)
316 * check: ide, usb, scsi, mmc
318 for (i
= ENUM_IDE
; i
< ENUM_MAX
; i
++) {
319 if (dev_enum_stor(i
, di
))
326 static int dev_stor_is_valid(int type
, block_dev_desc_t
*dd
)
330 for (i
= 0; i
< specs
[type
].max_dev
; i
++)
331 if (dd
== get_dev(specs
[type
].name
, i
))
332 if (dd
->type
!= DEV_TYPE_UNKNOWN
)
339 int dev_open_stor(void *cookie
)
341 int type
= dev_stor_type(cookie
);
343 if (type
== ENUM_MAX
)
346 if (dev_stor_is_valid(type
, (block_dev_desc_t
*)cookie
))
353 int dev_close_stor(void *cookie
)
356 * Not much to do as we actually do not alter storage devices upon
363 static int dev_stor_index(block_dev_desc_t
*dd
)
367 type
= dev_stor_type(dd
);
368 for (i
= 0; i
< specs
[type
].max_dev
; i
++)
369 if (dd
== get_dev(specs
[type
].name
, i
))
372 return (specs
[type
].max_dev
);
376 lbasize_t
dev_read_stor(void *cookie
, void *buf
, lbasize_t len
, lbastart_t start
)
379 block_dev_desc_t
*dd
= (block_dev_desc_t
*)cookie
;
381 if ((type
= dev_stor_type(dd
)) == ENUM_MAX
)
384 if (!dev_stor_is_valid(type
, dd
))
387 if ((dd
->block_read
) == NULL
) {
388 debugf("no block_read() for device 0x%08x\n", cookie
);
392 return (dd
->block_read(dev_stor_index(dd
), start
, len
, buf
));
395 #endif /* CONFIG_API */