karo: tx6ul: fix ENFC_CLK_SEL bitmask

[karo-tx-uboot.git] / drivers / core / simple-bus.c

diff --git a/drivers/core/simple-bus.c b/drivers/core/simple-bus.c
index 3ea4d8230bddeb4d01073538e8aea32618354327..913c3ccc70b6a06c22f6e25b4a58eff3874efeaf 100644 (file)
--- a/drivers/core/simple-bus.c
+++ b/drivers/core/simple-bus.c
@@ -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[] = {