2 * Copyright (C) 2016 Google, Inc
3 * Written by Simon Glass <sjg@chromium.org>
5 * SPDX-License-Identifier: GPL-2.0+
11 #include <dm/device-internal.h>
14 static const char *if_typename_str
[IF_TYPE_COUNT
] = {
15 [IF_TYPE_IDE
] = "ide",
16 [IF_TYPE_SCSI
] = "scsi",
17 [IF_TYPE_ATAPI
] = "atapi",
18 [IF_TYPE_USB
] = "usb",
19 [IF_TYPE_DOC
] = "doc",
20 [IF_TYPE_MMC
] = "mmc",
22 [IF_TYPE_SATA
] = "sata",
23 [IF_TYPE_HOST
] = "host",
24 [IF_TYPE_SYSTEMACE
] = "ace",
27 static enum uclass_id if_type_uclass_id
[IF_TYPE_COUNT
] = {
28 [IF_TYPE_IDE
] = UCLASS_INVALID
,
29 [IF_TYPE_SCSI
] = UCLASS_SCSI
,
30 [IF_TYPE_ATAPI
] = UCLASS_INVALID
,
31 [IF_TYPE_USB
] = UCLASS_MASS_STORAGE
,
32 [IF_TYPE_DOC
] = UCLASS_INVALID
,
33 [IF_TYPE_MMC
] = UCLASS_MMC
,
34 [IF_TYPE_SD
] = UCLASS_INVALID
,
35 [IF_TYPE_SATA
] = UCLASS_AHCI
,
36 [IF_TYPE_HOST
] = UCLASS_ROOT
,
37 [IF_TYPE_SYSTEMACE
] = UCLASS_INVALID
,
40 static enum if_type
if_typename_to_iftype(const char *if_typename
)
44 for (i
= 0; i
< IF_TYPE_COUNT
; i
++) {
45 if (if_typename_str
[i
] &&
46 !strcmp(if_typename
, if_typename_str
[i
]))
50 return IF_TYPE_UNKNOWN
;
53 static enum uclass_id
if_type_to_uclass_id(enum if_type if_type
)
55 return if_type_uclass_id
[if_type
];
58 struct blk_desc
*blk_get_devnum_by_type(enum if_type if_type
, int devnum
)
60 struct blk_desc
*desc
;
64 ret
= blk_get_device(if_type
, devnum
, &dev
);
67 desc
= dev_get_uclass_platdata(dev
);
73 * This function is complicated with driver model. We look up the interface
74 * name in a local table. This gives us an interface type which we can match
75 * against the uclass of the block device's parent.
77 struct blk_desc
*blk_get_devnum_by_typename(const char *if_typename
, int devnum
)
79 enum uclass_id uclass_id
;
85 if_type
= if_typename_to_iftype(if_typename
);
86 if (if_type
== IF_TYPE_UNKNOWN
) {
87 debug("%s: Unknown interface type '%s'\n", __func__
,
91 uclass_id
= if_type_to_uclass_id(if_type
);
92 if (uclass_id
== UCLASS_INVALID
) {
93 debug("%s: Unknown uclass for interface type'\n",
94 if_typename_str
[if_type
]);
98 ret
= uclass_get(UCLASS_BLK
, &uc
);
101 uclass_foreach_dev(dev
, uc
) {
102 struct blk_desc
*desc
= dev_get_uclass_platdata(dev
);
104 debug("%s: if_type=%d, devnum=%d: %s, %d, %d\n", __func__
,
105 if_type
, devnum
, dev
->name
, desc
->if_type
, desc
->devnum
);
106 if (desc
->devnum
!= devnum
)
109 /* Find out the parent device uclass */
110 if (device_get_uclass_id(dev
->parent
) != uclass_id
) {
111 debug("%s: parent uclass %d, this dev %d\n", __func__
,
112 device_get_uclass_id(dev
->parent
), uclass_id
);
116 if (device_probe(dev
))
119 debug("%s: Device desc %p\n", __func__
, desc
);
122 debug("%s: No device found\n", __func__
);
128 * get_desc() - Get the block device descriptor for the given device number
130 * @if_type: Interface type
131 * @devnum: Device number (0 = first)
132 * @descp: Returns block device descriptor on success
133 * @return 0 on success, -ENODEV if there is no such device and no device
134 * with a higher device number, -ENOENT if there is no such device but there
135 * is one with a higher number, or other -ve on other error.
137 static int get_desc(enum if_type if_type
, int devnum
, struct blk_desc
**descp
)
139 bool found_more
= false;
145 ret
= uclass_get(UCLASS_BLK
, &uc
);
148 uclass_foreach_dev(dev
, uc
) {
149 struct blk_desc
*desc
= dev_get_uclass_platdata(dev
);
151 debug("%s: if_type=%d, devnum=%d: %s, %d, %d\n", __func__
,
152 if_type
, devnum
, dev
->name
, desc
->if_type
, desc
->devnum
);
153 if (desc
->if_type
== if_type
) {
154 if (desc
->devnum
== devnum
) {
155 ret
= device_probe(dev
);
161 } else if (desc
->devnum
> devnum
) {
167 return found_more
? -ENOENT
: -ENODEV
;
170 int blk_select_hwpart_devnum(enum if_type if_type
, int devnum
, int hwpart
)
175 ret
= blk_get_device(if_type
, devnum
, &dev
);
179 return blk_select_hwpart(dev
, hwpart
);
182 int blk_list_part(enum if_type if_type
)
184 struct blk_desc
*desc
;
188 for (ok
= 0, devnum
= 0;; ++devnum
) {
189 ret
= get_desc(if_type
, devnum
, &desc
);
194 if (desc
->part_type
!= PART_TYPE_UNKNOWN
) {
207 int blk_print_part_devnum(enum if_type if_type
, int devnum
)
209 struct blk_desc
*desc
;
212 ret
= get_desc(if_type
, devnum
, &desc
);
215 if (desc
->type
== DEV_TYPE_UNKNOWN
)
222 void blk_list_devices(enum if_type if_type
)
224 struct blk_desc
*desc
;
229 ret
= get_desc(if_type
, i
, &desc
);
234 if (desc
->type
== DEV_TYPE_UNKNOWN
)
235 continue; /* list only known devices */
236 printf("Device %d: ", i
);
241 int blk_print_device_num(enum if_type if_type
, int devnum
)
243 struct blk_desc
*desc
;
246 ret
= get_desc(if_type
, devnum
, &desc
);
249 printf("\nIDE device %d: ", devnum
);
255 int blk_show_device(enum if_type if_type
, int devnum
)
257 struct blk_desc
*desc
;
260 printf("\nDevice %d: ", devnum
);
261 ret
= get_desc(if_type
, devnum
, &desc
);
262 if (ret
== -ENODEV
|| ret
== -ENOENT
) {
263 printf("unknown device\n");
270 if (desc
->type
== DEV_TYPE_UNKNOWN
)
276 ulong
blk_read_devnum(enum if_type if_type
, int devnum
, lbaint_t start
,
277 lbaint_t blkcnt
, void *buffer
)
279 struct blk_desc
*desc
;
283 ret
= get_desc(if_type
, devnum
, &desc
);
286 n
= blk_dread(desc
, start
, blkcnt
, buffer
);
290 /* flush cache after read */
291 flush_cache((ulong
)buffer
, blkcnt
* desc
->blksz
);
296 ulong
blk_write_devnum(enum if_type if_type
, int devnum
, lbaint_t start
,
297 lbaint_t blkcnt
, const void *buffer
)
299 struct blk_desc
*desc
;
302 ret
= get_desc(if_type
, devnum
, &desc
);
305 return blk_dwrite(desc
, start
, blkcnt
, buffer
);
308 int blk_select_hwpart(struct udevice
*dev
, int hwpart
)
310 const struct blk_ops
*ops
= blk_get_ops(dev
);
314 if (!ops
->select_hwpart
)
317 return ops
->select_hwpart(dev
, hwpart
);
320 int blk_dselect_hwpart(struct blk_desc
*desc
, int hwpart
)
322 return blk_select_hwpart(desc
->bdev
, hwpart
);
325 int blk_first_device(int if_type
, struct udevice
**devp
)
327 struct blk_desc
*desc
;
330 ret
= uclass_first_device(UCLASS_BLK
, devp
);
336 desc
= dev_get_uclass_platdata(*devp
);
337 if (desc
->if_type
== if_type
)
339 ret
= uclass_next_device(devp
);
347 int blk_next_device(struct udevice
**devp
)
349 struct blk_desc
*desc
;
352 desc
= dev_get_uclass_platdata(*devp
);
353 if_type
= desc
->if_type
;
355 ret
= uclass_next_device(devp
);
360 desc
= dev_get_uclass_platdata(*devp
);
361 if (desc
->if_type
== if_type
)
366 int blk_get_device(int if_type
, int devnum
, struct udevice
**devp
)
372 ret
= uclass_get(UCLASS_BLK
, &uc
);
375 uclass_foreach_dev(dev
, uc
) {
376 struct blk_desc
*desc
= dev_get_uclass_platdata(dev
);
378 debug("%s: if_type=%d, devnum=%d: %s, %d, %d\n", __func__
,
379 if_type
, devnum
, dev
->name
, desc
->if_type
, desc
->devnum
);
380 if (desc
->if_type
== if_type
&& desc
->devnum
== devnum
) {
382 return device_probe(dev
);
389 unsigned long blk_dread(struct blk_desc
*block_dev
, lbaint_t start
,
390 lbaint_t blkcnt
, void *buffer
)
392 struct udevice
*dev
= block_dev
->bdev
;
393 const struct blk_ops
*ops
= blk_get_ops(dev
);
399 if (blkcache_read(block_dev
->if_type
, block_dev
->devnum
,
400 start
, blkcnt
, block_dev
->blksz
, buffer
))
402 blks_read
= ops
->read(dev
, start
, blkcnt
, buffer
);
403 if (blks_read
== blkcnt
)
404 blkcache_fill(block_dev
->if_type
, block_dev
->devnum
,
405 start
, blkcnt
, block_dev
->blksz
, buffer
);
410 unsigned long blk_dwrite(struct blk_desc
*block_dev
, lbaint_t start
,
411 lbaint_t blkcnt
, const void *buffer
)
413 struct udevice
*dev
= block_dev
->bdev
;
414 const struct blk_ops
*ops
= blk_get_ops(dev
);
419 blkcache_invalidate(block_dev
->if_type
, block_dev
->devnum
);
420 return ops
->write(dev
, start
, blkcnt
, buffer
);
423 unsigned long blk_derase(struct blk_desc
*block_dev
, lbaint_t start
,
426 struct udevice
*dev
= block_dev
->bdev
;
427 const struct blk_ops
*ops
= blk_get_ops(dev
);
432 blkcache_invalidate(block_dev
->if_type
, block_dev
->devnum
);
433 return ops
->erase(dev
, start
, blkcnt
);
436 int blk_prepare_device(struct udevice
*dev
)
438 struct blk_desc
*desc
= dev_get_uclass_platdata(dev
);
445 int blk_find_max_devnum(enum if_type if_type
)
448 int max_devnum
= -ENODEV
;
452 ret
= uclass_get(UCLASS_BLK
, &uc
);
455 uclass_foreach_dev(dev
, uc
) {
456 struct blk_desc
*desc
= dev_get_uclass_platdata(dev
);
458 if (desc
->if_type
== if_type
&& desc
->devnum
> max_devnum
)
459 max_devnum
= desc
->devnum
;
465 int blk_create_device(struct udevice
*parent
, const char *drv_name
,
466 const char *name
, int if_type
, int devnum
, int blksz
,
467 lbaint_t size
, struct udevice
**devp
)
469 struct blk_desc
*desc
;
474 ret
= blk_find_max_devnum(if_type
);
482 ret
= device_bind_driver(parent
, drv_name
, name
, &dev
);
485 desc
= dev_get_uclass_platdata(dev
);
486 desc
->if_type
= if_type
;
488 desc
->lba
= size
/ blksz
;
489 desc
->part_type
= PART_TYPE_UNKNOWN
;
491 desc
->devnum
= devnum
;
497 int blk_create_devicef(struct udevice
*parent
, const char *drv_name
,
498 const char *name
, int if_type
, int devnum
, int blksz
,
499 lbaint_t size
, struct udevice
**devp
)
501 char dev_name
[30], *str
;
504 snprintf(dev_name
, sizeof(dev_name
), "%s.%s", parent
->name
, name
);
505 str
= strdup(dev_name
);
509 ret
= blk_create_device(parent
, drv_name
, str
, if_type
, devnum
,
515 device_set_name_alloced(*devp
);
520 int blk_unbind_all(int if_type
)
523 struct udevice
*dev
, *next
;
526 ret
= uclass_get(UCLASS_BLK
, &uc
);
529 uclass_foreach_dev_safe(dev
, next
, uc
) {
530 struct blk_desc
*desc
= dev_get_uclass_platdata(dev
);
532 if (desc
->if_type
== if_type
) {
533 ret
= device_remove(dev
, DM_REMOVE_NORMAL
);
536 ret
= device_unbind(dev
);
545 UCLASS_DRIVER(blk
) = {
548 .per_device_platdata_auto_alloc_size
= sizeof(struct blk_desc
),