1500856ebSRafal Jaworowski /* 2*f2302d44SStefan Roese * (C) Copyright 2007-2008 Semihalf 3500856ebSRafal Jaworowski * 4500856ebSRafal Jaworowski * Written by: Rafal Jaworowski <raj@semihalf.com> 5500856ebSRafal Jaworowski * 6500856ebSRafal Jaworowski * See file CREDITS for list of people who contributed to this 7500856ebSRafal Jaworowski * project. 8500856ebSRafal Jaworowski * 9500856ebSRafal Jaworowski * This program is free software; you can redistribute it and/or 10500856ebSRafal Jaworowski * modify it under the terms of the GNU General Public License as 11500856ebSRafal Jaworowski * published by the Free Software Foundation; either version 2 of 12500856ebSRafal Jaworowski * the License, or (at your option) any later version. 13500856ebSRafal Jaworowski * 14500856ebSRafal Jaworowski * This program is distributed in the hope that it will be useful, 15500856ebSRafal Jaworowski * but WITHOUT ANY WARRANTY; without even the implied warranty of 16500856ebSRafal Jaworowski * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 17500856ebSRafal Jaworowski * GNU General Public License for more details. 18500856ebSRafal Jaworowski * 19500856ebSRafal Jaworowski * You should have received a copy of the GNU General Public License 20500856ebSRafal Jaworowski * along with this program; if not, write to the Free Software 21500856ebSRafal Jaworowski * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 22500856ebSRafal Jaworowski * MA 02111-1307 USA 23500856ebSRafal Jaworowski * 24500856ebSRafal Jaworowski */ 25500856ebSRafal Jaworowski 26500856ebSRafal Jaworowski #include <config.h> 27500856ebSRafal Jaworowski 28500856ebSRafal Jaworowski #if defined(CONFIG_API) 29500856ebSRafal Jaworowski 30500856ebSRafal Jaworowski #include <common.h> 31500856ebSRafal Jaworowski #include <api_public.h> 32500856ebSRafal Jaworowski 33500856ebSRafal Jaworowski #define DEBUG 34500856ebSRafal Jaworowski #undef DEBUG 35500856ebSRafal Jaworowski 36500856ebSRafal Jaworowski #ifdef DEBUG 37500856ebSRafal Jaworowski #define debugf(fmt, args...) do { printf("%s(): ", __func__); printf(fmt, ##args); } while (0) 38500856ebSRafal Jaworowski #else 39500856ebSRafal Jaworowski #define debugf(fmt, args...) 40500856ebSRafal Jaworowski #endif 41500856ebSRafal Jaworowski 42500856ebSRafal Jaworowski #define errf(fmt, args...) do { printf("ERROR @ %s(): ", __func__); printf(fmt, ##args); } while (0) 43500856ebSRafal Jaworowski 44500856ebSRafal Jaworowski 45500856ebSRafal Jaworowski #define ENUM_IDE 0 46500856ebSRafal Jaworowski #define ENUM_USB 1 47500856ebSRafal Jaworowski #define ENUM_SCSI 2 48500856ebSRafal Jaworowski #define ENUM_MMC 3 49*f2302d44SStefan Roese #define ENUM_SATA 4 50*f2302d44SStefan Roese #define ENUM_MAX 5 51500856ebSRafal Jaworowski 52500856ebSRafal Jaworowski struct stor_spec { 53500856ebSRafal Jaworowski int max_dev; 54500856ebSRafal Jaworowski int enum_started; 55500856ebSRafal Jaworowski int enum_ended; 56500856ebSRafal Jaworowski int type; /* "external" type: DT_STOR_{IDE,USB,etc} */ 57*f2302d44SStefan Roese char *name; 58500856ebSRafal Jaworowski }; 59500856ebSRafal Jaworowski 60500856ebSRafal Jaworowski static struct stor_spec specs[ENUM_MAX] = { { 0, 0, 0, 0, "" }, }; 61500856ebSRafal Jaworowski 62500856ebSRafal Jaworowski 63500856ebSRafal Jaworowski void dev_stor_init(void) 64500856ebSRafal Jaworowski { 651b769881SJean-Christophe PLAGNIOL-VILLARD #if defined(CONFIG_CMD_IDE) 66500856ebSRafal Jaworowski specs[ENUM_IDE].max_dev = CFG_IDE_MAXDEVICE; 67500856ebSRafal Jaworowski specs[ENUM_IDE].enum_started = 0; 68500856ebSRafal Jaworowski specs[ENUM_IDE].enum_ended = 0; 69500856ebSRafal Jaworowski specs[ENUM_IDE].type = DEV_TYP_STOR | DT_STOR_IDE; 70500856ebSRafal Jaworowski specs[ENUM_IDE].name = "ide"; 71500856ebSRafal Jaworowski #endif 72*f2302d44SStefan Roese #if defined(CONFIG_CMD_MMC) 73*f2302d44SStefan Roese specs[ENUM_MMC].max_dev = CFG_MMC_MAX_DEVICE; 74*f2302d44SStefan Roese specs[ENUM_MMC].enum_started = 0; 75*f2302d44SStefan Roese specs[ENUM_MMC].enum_ended = 0; 76*f2302d44SStefan Roese specs[ENUM_MMC].type = DEV_TYP_STOR | DT_STOR_MMC; 77*f2302d44SStefan Roese specs[ENUM_MMC].name = "mmc"; 78*f2302d44SStefan Roese #endif 79*f2302d44SStefan Roese #if defined(CONFIG_CMD_SATA) 80*f2302d44SStefan Roese specs[ENUM_SATA].max_dev = CFG_SATA_MAX_DEVICE; 81*f2302d44SStefan Roese specs[ENUM_SATA].enum_started = 0; 82*f2302d44SStefan Roese specs[ENUM_SATA].enum_ended = 0; 83*f2302d44SStefan Roese specs[ENUM_SATA].type = DEV_TYP_STOR | DT_STOR_SATA; 84*f2302d44SStefan Roese specs[ENUM_SATA].name = "sata"; 85500856ebSRafal Jaworowski #endif 861b769881SJean-Christophe PLAGNIOL-VILLARD #if defined(CONFIG_CMD_SCSI) 87500856ebSRafal Jaworowski specs[ENUM_SCSI].max_dev = CFG_SCSI_MAX_DEVICE; 88500856ebSRafal Jaworowski specs[ENUM_SCSI].enum_started = 0; 89500856ebSRafal Jaworowski specs[ENUM_SCSI].enum_ended = 0; 90500856ebSRafal Jaworowski specs[ENUM_SCSI].type = DEV_TYP_STOR | DT_STOR_SCSI; 91500856ebSRafal Jaworowski specs[ENUM_SCSI].name = "scsi"; 92500856ebSRafal Jaworowski #endif 93*f2302d44SStefan Roese #if defined(CONFIG_CMD_USB) && defined(CONFIG_USB_STORAGE) 94*f2302d44SStefan Roese specs[ENUM_USB].max_dev = USB_MAX_STOR_DEV; 95*f2302d44SStefan Roese specs[ENUM_USB].enum_started = 0; 96*f2302d44SStefan Roese specs[ENUM_USB].enum_ended = 0; 97*f2302d44SStefan Roese specs[ENUM_USB].type = DEV_TYP_STOR | DT_STOR_USB; 98*f2302d44SStefan Roese specs[ENUM_USB].name = "usb"; 99*f2302d44SStefan Roese #endif 100500856ebSRafal Jaworowski } 101500856ebSRafal Jaworowski 102500856ebSRafal Jaworowski /* 103500856ebSRafal Jaworowski * Finds next available device in the storage group 104500856ebSRafal Jaworowski * 105500856ebSRafal Jaworowski * type: storage group type - ENUM_IDE, ENUM_SCSI etc. 106500856ebSRafal Jaworowski * 107500856ebSRafal Jaworowski * first: if 1 the first device in the storage group is returned (if 108500856ebSRafal Jaworowski * exists), if 0 the next available device is searched 109500856ebSRafal Jaworowski * 110500856ebSRafal Jaworowski * more: returns 0/1 depending if there are more devices in this group 111500856ebSRafal Jaworowski * available (for future iterations) 112500856ebSRafal Jaworowski * 113500856ebSRafal Jaworowski * returns: 0/1 depending if device found in this iteration 114500856ebSRafal Jaworowski */ 115500856ebSRafal Jaworowski static int dev_stor_get(int type, int first, int *more, struct device_info *di) 116500856ebSRafal Jaworowski { 117500856ebSRafal Jaworowski int found = 0; 118500856ebSRafal Jaworowski *more = 0; 119500856ebSRafal Jaworowski 120500856ebSRafal Jaworowski int i; 121500856ebSRafal Jaworowski 122500856ebSRafal Jaworowski block_dev_desc_t *dd; 123500856ebSRafal Jaworowski 124500856ebSRafal Jaworowski if (first) { 125500856ebSRafal Jaworowski di->cookie = (void *)get_dev(specs[type].name, 0); 126*f2302d44SStefan Roese if (di->cookie == NULL) 127*f2302d44SStefan Roese return 0; 128*f2302d44SStefan Roese else 129500856ebSRafal Jaworowski found = 1; 130500856ebSRafal Jaworowski 131500856ebSRafal Jaworowski } else { 132500856ebSRafal Jaworowski for (i = 0; i < specs[type].max_dev; i++) 133500856ebSRafal Jaworowski if (di->cookie == (void *)get_dev(specs[type].name, i)) { 134500856ebSRafal Jaworowski /* previous cookie found -- advance to the 135500856ebSRafal Jaworowski * next device, if possible */ 136500856ebSRafal Jaworowski 137500856ebSRafal Jaworowski if (++i >= specs[type].max_dev) { 138500856ebSRafal Jaworowski /* out of range, no more to enum */ 139500856ebSRafal Jaworowski di->cookie = NULL; 140500856ebSRafal Jaworowski break; 141500856ebSRafal Jaworowski } 142500856ebSRafal Jaworowski 143500856ebSRafal Jaworowski di->cookie = (void *)get_dev(specs[type].name, i); 144*f2302d44SStefan Roese if (di->cookie == NULL) 145*f2302d44SStefan Roese return 0; 146*f2302d44SStefan Roese else 147500856ebSRafal Jaworowski found = 1; 148500856ebSRafal Jaworowski 149500856ebSRafal Jaworowski /* provide hint if there are more devices in 150500856ebSRafal Jaworowski * this group to enumerate */ 151500856ebSRafal Jaworowski if ((i + 1) < specs[type].max_dev) 152500856ebSRafal Jaworowski *more = 1; 153500856ebSRafal Jaworowski 154500856ebSRafal Jaworowski break; 155500856ebSRafal Jaworowski } 156500856ebSRafal Jaworowski } 157500856ebSRafal Jaworowski 158500856ebSRafal Jaworowski if (found) { 159500856ebSRafal Jaworowski di->type = specs[type].type; 160500856ebSRafal Jaworowski 161500856ebSRafal Jaworowski if (di->cookie != NULL) { 162500856ebSRafal Jaworowski dd = (block_dev_desc_t *)di->cookie; 163500856ebSRafal Jaworowski if (dd->type == DEV_TYPE_UNKNOWN) { 164500856ebSRafal Jaworowski debugf("device instance exists, but is not active.."); 165500856ebSRafal Jaworowski found = 0; 166500856ebSRafal Jaworowski } else { 167500856ebSRafal Jaworowski di->di_stor.block_count = dd->lba; 168500856ebSRafal Jaworowski di->di_stor.block_size = dd->blksz; 169500856ebSRafal Jaworowski } 170500856ebSRafal Jaworowski } 171500856ebSRafal Jaworowski 172500856ebSRafal Jaworowski } else 173500856ebSRafal Jaworowski di->cookie = NULL; 174500856ebSRafal Jaworowski 175500856ebSRafal Jaworowski return found; 176500856ebSRafal Jaworowski } 177500856ebSRafal Jaworowski 178500856ebSRafal Jaworowski 179500856ebSRafal Jaworowski /* 180500856ebSRafal Jaworowski * returns: ENUM_IDE, ENUM_USB etc. based on block_dev_desc_t 181500856ebSRafal Jaworowski */ 182500856ebSRafal Jaworowski static int dev_stor_type(block_dev_desc_t *dd) 183500856ebSRafal Jaworowski { 184500856ebSRafal Jaworowski int i, j; 185500856ebSRafal Jaworowski 186500856ebSRafal Jaworowski for (i = ENUM_IDE; i < ENUM_MAX; i++) 187500856ebSRafal Jaworowski for (j = 0; j < specs[i].max_dev; j++) 188500856ebSRafal Jaworowski if (dd == get_dev(specs[i].name, j)) 189500856ebSRafal Jaworowski return i; 190500856ebSRafal Jaworowski 191500856ebSRafal Jaworowski return ENUM_MAX; 192500856ebSRafal Jaworowski } 193500856ebSRafal Jaworowski 194500856ebSRafal Jaworowski 195500856ebSRafal Jaworowski /* 196500856ebSRafal Jaworowski * returns: 0/1 whether cookie points to some device in this group 197500856ebSRafal Jaworowski */ 198500856ebSRafal Jaworowski static int dev_is_stor(int type, struct device_info *di) 199500856ebSRafal Jaworowski { 200500856ebSRafal Jaworowski return (dev_stor_type(di->cookie) == type) ? 1 : 0; 201500856ebSRafal Jaworowski } 202500856ebSRafal Jaworowski 203500856ebSRafal Jaworowski 204500856ebSRafal Jaworowski static int dev_enum_stor(int type, struct device_info *di) 205500856ebSRafal Jaworowski { 206500856ebSRafal Jaworowski int found = 0, more = 0; 207500856ebSRafal Jaworowski 208500856ebSRafal Jaworowski debugf("called, type %d\n", type); 209500856ebSRafal Jaworowski 210500856ebSRafal Jaworowski /* 211500856ebSRafal Jaworowski * Formulae for enumerating storage devices: 212500856ebSRafal Jaworowski * 1. if cookie (hint from previous enum call) is NULL we start again 213500856ebSRafal Jaworowski * with enumeration, so return the first available device, done. 214500856ebSRafal Jaworowski * 215500856ebSRafal Jaworowski * 2. if cookie is not NULL, check if it identifies some device in 216500856ebSRafal Jaworowski * this group: 217500856ebSRafal Jaworowski * 218500856ebSRafal Jaworowski * 2a. if cookie is a storage device from our group (IDE, USB etc.), 219500856ebSRafal Jaworowski * return next available (if exists) in this group 220500856ebSRafal Jaworowski * 221500856ebSRafal Jaworowski * 2b. if it isn't device from our group, check if such devices were 222500856ebSRafal Jaworowski * ever enumerated before: 223500856ebSRafal Jaworowski * - if not, return the first available device from this group 224500856ebSRafal Jaworowski * - else return 0 225500856ebSRafal Jaworowski */ 226500856ebSRafal Jaworowski 227500856ebSRafal Jaworowski if (di->cookie == NULL) { 228500856ebSRafal Jaworowski 229500856ebSRafal Jaworowski debugf("group%d - enum restart\n", type); 230500856ebSRafal Jaworowski 231500856ebSRafal Jaworowski /* 232500856ebSRafal Jaworowski * 1. Enumeration (re-)started: take the first available 233500856ebSRafal Jaworowski * device, if exists 234500856ebSRafal Jaworowski */ 235500856ebSRafal Jaworowski found = dev_stor_get(type, 1, &more, di); 236500856ebSRafal Jaworowski specs[type].enum_started = 1; 237500856ebSRafal Jaworowski 238500856ebSRafal Jaworowski } else if (dev_is_stor(type, di)) { 239500856ebSRafal Jaworowski 240500856ebSRafal Jaworowski debugf("group%d - enum continued for the next device\n", type); 241500856ebSRafal Jaworowski 242500856ebSRafal Jaworowski if (specs[type].enum_ended) { 243500856ebSRafal Jaworowski debugf("group%d - nothing more to enum!\n", type); 244500856ebSRafal Jaworowski return 0; 245500856ebSRafal Jaworowski } 246500856ebSRafal Jaworowski 247500856ebSRafal Jaworowski /* 2a. Attempt to take a next available device in the group */ 248500856ebSRafal Jaworowski found = dev_stor_get(type, 0, &more, di); 249500856ebSRafal Jaworowski 250500856ebSRafal Jaworowski } else { 251500856ebSRafal Jaworowski 252500856ebSRafal Jaworowski if (specs[type].enum_ended) { 253500856ebSRafal Jaworowski debugf("group %d - already enumerated, skipping\n", type); 254500856ebSRafal Jaworowski return 0; 255500856ebSRafal Jaworowski } 256500856ebSRafal Jaworowski 257500856ebSRafal Jaworowski debugf("group%d - first time enum\n", type); 258500856ebSRafal Jaworowski 259500856ebSRafal Jaworowski if (specs[type].enum_started == 0) { 260500856ebSRafal Jaworowski /* 261500856ebSRafal Jaworowski * 2b. If enumerating devices in this group did not 262500856ebSRafal Jaworowski * happen before, it means the cookie pointed to a 263500856ebSRafal Jaworowski * device frome some other group (another storage 264500856ebSRafal Jaworowski * group, or network); in this case try to take the 265500856ebSRafal Jaworowski * first available device from our group 266500856ebSRafal Jaworowski */ 267500856ebSRafal Jaworowski specs[type].enum_started = 1; 268500856ebSRafal Jaworowski 269500856ebSRafal Jaworowski /* 270500856ebSRafal Jaworowski * Attempt to take the first device in this group: 271500856ebSRafal Jaworowski *'first element' flag is set 272500856ebSRafal Jaworowski */ 273500856ebSRafal Jaworowski found = dev_stor_get(type, 1, &more, di); 274500856ebSRafal Jaworowski 275500856ebSRafal Jaworowski } else { 276500856ebSRafal Jaworowski errf("group%d - out of order iteration\n", type); 277500856ebSRafal Jaworowski found = 0; 278500856ebSRafal Jaworowski more = 0; 279500856ebSRafal Jaworowski } 280500856ebSRafal Jaworowski } 281500856ebSRafal Jaworowski 282500856ebSRafal Jaworowski /* 283500856ebSRafal Jaworowski * If there are no more devices in this group, consider its 284500856ebSRafal Jaworowski * enumeration finished 285500856ebSRafal Jaworowski */ 286500856ebSRafal Jaworowski specs[type].enum_ended = (!more) ? 1 : 0; 287500856ebSRafal Jaworowski 288500856ebSRafal Jaworowski if (found) 289500856ebSRafal Jaworowski debugf("device found, returning cookie 0x%08x\n", 290500856ebSRafal Jaworowski (u_int32_t)di->cookie); 291500856ebSRafal Jaworowski else 292500856ebSRafal Jaworowski debugf("no device found\n"); 293500856ebSRafal Jaworowski 294500856ebSRafal Jaworowski return found; 295500856ebSRafal Jaworowski } 296500856ebSRafal Jaworowski 297500856ebSRafal Jaworowski void dev_enum_reset(void) 298500856ebSRafal Jaworowski { 299500856ebSRafal Jaworowski int i; 300500856ebSRafal Jaworowski 301500856ebSRafal Jaworowski for (i = 0; i < ENUM_MAX; i ++) { 302500856ebSRafal Jaworowski specs[i].enum_started = 0; 303500856ebSRafal Jaworowski specs[i].enum_ended = 0; 304500856ebSRafal Jaworowski } 305500856ebSRafal Jaworowski } 306500856ebSRafal Jaworowski 307500856ebSRafal Jaworowski int dev_enum_storage(struct device_info *di) 308500856ebSRafal Jaworowski { 309500856ebSRafal Jaworowski int i; 310500856ebSRafal Jaworowski 311500856ebSRafal Jaworowski /* 312500856ebSRafal Jaworowski * check: ide, usb, scsi, mmc 313500856ebSRafal Jaworowski */ 314500856ebSRafal Jaworowski for (i = ENUM_IDE; i < ENUM_MAX; i ++) { 315500856ebSRafal Jaworowski if (dev_enum_stor(i, di)) 316500856ebSRafal Jaworowski return 1; 317500856ebSRafal Jaworowski } 318500856ebSRafal Jaworowski 319500856ebSRafal Jaworowski return 0; 320500856ebSRafal Jaworowski } 321500856ebSRafal Jaworowski 322500856ebSRafal Jaworowski static int dev_stor_is_valid(int type, block_dev_desc_t *dd) 323500856ebSRafal Jaworowski { 324500856ebSRafal Jaworowski int i; 325500856ebSRafal Jaworowski 326500856ebSRafal Jaworowski for (i = 0; i < specs[type].max_dev; i++) 327500856ebSRafal Jaworowski if (dd == get_dev(specs[type].name, i)) 328500856ebSRafal Jaworowski if (dd->type != DEV_TYPE_UNKNOWN) 329500856ebSRafal Jaworowski return 1; 330500856ebSRafal Jaworowski 331500856ebSRafal Jaworowski return 0; 332500856ebSRafal Jaworowski } 333500856ebSRafal Jaworowski 334500856ebSRafal Jaworowski 335500856ebSRafal Jaworowski int dev_open_stor(void *cookie) 336500856ebSRafal Jaworowski { 337500856ebSRafal Jaworowski int type = dev_stor_type(cookie); 338500856ebSRafal Jaworowski 339500856ebSRafal Jaworowski if (type == ENUM_MAX) 340500856ebSRafal Jaworowski return API_ENODEV; 341500856ebSRafal Jaworowski 342500856ebSRafal Jaworowski if (dev_stor_is_valid(type, (block_dev_desc_t *)cookie)) 343500856ebSRafal Jaworowski return 0; 344500856ebSRafal Jaworowski 345500856ebSRafal Jaworowski return API_ENODEV; 346500856ebSRafal Jaworowski } 347500856ebSRafal Jaworowski 348500856ebSRafal Jaworowski 349500856ebSRafal Jaworowski int dev_close_stor(void *cookie) 350500856ebSRafal Jaworowski { 351500856ebSRafal Jaworowski /* 352500856ebSRafal Jaworowski * Not much to do as we actually do not alter storage devices upon 353500856ebSRafal Jaworowski * close 354500856ebSRafal Jaworowski */ 355500856ebSRafal Jaworowski return 0; 356500856ebSRafal Jaworowski } 357500856ebSRafal Jaworowski 358500856ebSRafal Jaworowski 359500856ebSRafal Jaworowski static int dev_stor_index(block_dev_desc_t *dd) 360500856ebSRafal Jaworowski { 361500856ebSRafal Jaworowski int i, type; 362500856ebSRafal Jaworowski 363500856ebSRafal Jaworowski type = dev_stor_type(dd); 364500856ebSRafal Jaworowski for (i = 0; i < specs[type].max_dev; i++) 365500856ebSRafal Jaworowski if (dd == get_dev(specs[type].name, i)) 366500856ebSRafal Jaworowski return i; 367500856ebSRafal Jaworowski 368500856ebSRafal Jaworowski return (specs[type].max_dev); 369500856ebSRafal Jaworowski } 370500856ebSRafal Jaworowski 371500856ebSRafal Jaworowski 372500856ebSRafal Jaworowski lbasize_t dev_read_stor(void *cookie, void *buf, lbasize_t len, lbastart_t start) 373500856ebSRafal Jaworowski { 374500856ebSRafal Jaworowski int type; 375500856ebSRafal Jaworowski block_dev_desc_t *dd = (block_dev_desc_t *)cookie; 376500856ebSRafal Jaworowski 377500856ebSRafal Jaworowski if ((type = dev_stor_type(dd)) == ENUM_MAX) 378500856ebSRafal Jaworowski return 0; 379500856ebSRafal Jaworowski 380500856ebSRafal Jaworowski if (!dev_stor_is_valid(type, dd)) 381500856ebSRafal Jaworowski return 0; 382500856ebSRafal Jaworowski 383500856ebSRafal Jaworowski if ((dd->block_read) == NULL) { 384*f2302d44SStefan Roese debugf("no block_read() for device 0x%08x\n", cookie); 385500856ebSRafal Jaworowski return 0; 386500856ebSRafal Jaworowski } 387500856ebSRafal Jaworowski 388500856ebSRafal Jaworowski return (dd->block_read(dev_stor_index(dd), start, len, buf)); 389500856ebSRafal Jaworowski } 390500856ebSRafal Jaworowski 391500856ebSRafal Jaworowski #endif /* CONFIG_API */ 392