|
@@ -10,8 +10,37 @@
|
|
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
|
|
+struct simple_bus_plat {
|
|
|
+ u32 base;
|
|
|
+ u32 size;
|
|
|
+ u32 target;
|
|
|
+};
|
|
|
+
|
|
|
+fdt_addr_t simple_bus_translate(struct udevice *dev, fdt_addr_t addr)
|
|
|
+{
|
|
|
+ struct simple_bus_plat *plat = dev_get_uclass_platdata(dev);
|
|
|
+
|
|
|
+ if (addr >= plat->base && addr < plat->base + plat->size)
|
|
|
+ addr = (addr - plat->base) + plat->target;
|
|
|
+
|
|
|
+ return addr;
|
|
|
+}
|
|
|
+
|
|
|
static int simple_bus_post_bind(struct udevice *dev)
|
|
|
{
|
|
|
+ u32 cell[3];
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ ret = fdtdec_get_int_array(gd->fdt_blob, dev->of_offset, "ranges",
|
|
|
+ cell, ARRAY_SIZE(cell));
|
|
|
+ if (!ret) {
|
|
|
+ struct simple_bus_plat *plat = dev_get_uclass_platdata(dev);
|
|
|
+
|
|
|
+ plat->base = cell[0];
|
|
|
+ plat->target = cell[1];
|
|
|
+ plat->size = cell[2];
|
|
|
+ }
|
|
|
+
|
|
|
return dm_scan_fdt_node(dev, gd->fdt_blob, dev->of_offset, false);
|
|
|
}
|
|
|
|
|
@@ -19,6 +48,7 @@ UCLASS_DRIVER(simple_bus) = {
|
|
|
.id = UCLASS_SIMPLE_BUS,
|
|
|
.name = "simple_bus",
|
|
|
.post_bind = simple_bus_post_bind,
|
|
|
+ .per_device_platdata_auto_alloc_size = sizeof(struct simple_bus_plat),
|
|
|
};
|
|
|
|
|
|
static const struct udevice_id generic_simple_bus_ids[] = {
|