simple-bus.c 1.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (c) 2014 Google, Inc
  4. */
  5. #define LOG_CATEGORY UCLASS_SIMPLE_BUS
  6. #include <common.h>
  7. #include <asm/global_data.h>
  8. #include <dm.h>
  9. #include <dm/simple_bus.h>
  10. #include <fdt_support.h>
  11. DECLARE_GLOBAL_DATA_PTR;
  12. fdt_addr_t simple_bus_translate(struct udevice *dev, fdt_addr_t addr)
  13. {
  14. struct simple_bus_plat *plat = dev_get_uclass_plat(dev);
  15. if (addr >= plat->base && addr < plat->base + plat->size)
  16. addr = (addr - plat->base) + plat->target;
  17. return addr;
  18. }
  19. static int simple_bus_post_bind(struct udevice *dev)
  20. {
  21. #if CONFIG_IS_ENABLED(OF_PLATDATA)
  22. return 0;
  23. #else
  24. struct simple_bus_plat *plat = dev_get_uclass_plat(dev);
  25. int ret;
  26. if (CONFIG_IS_ENABLED(SIMPLE_BUS_CORRECT_RANGE)) {
  27. uint64_t caddr, paddr, len;
  28. /* only read range index 0 */
  29. ret = fdt_read_range((void *)gd->fdt_blob, dev_of_offset(dev),
  30. 0, &caddr, &paddr, &len);
  31. if (!ret) {
  32. plat->base = caddr;
  33. plat->target = paddr;
  34. plat->size = len;
  35. }
  36. } else {
  37. u32 cell[3];
  38. ret = dev_read_u32_array(dev, "ranges", cell,
  39. ARRAY_SIZE(cell));
  40. if (!ret) {
  41. plat->base = cell[0];
  42. plat->target = cell[1];
  43. plat->size = cell[2];
  44. }
  45. }
  46. return dm_scan_fdt_dev(dev);
  47. #endif
  48. }
  49. UCLASS_DRIVER(simple_bus) = {
  50. .id = UCLASS_SIMPLE_BUS,
  51. .name = "simple_bus",
  52. .post_bind = simple_bus_post_bind,
  53. .per_device_plat_auto = sizeof(struct simple_bus_plat),
  54. };
  55. #if !CONFIG_IS_ENABLED(OF_PLATDATA)
  56. static const struct udevice_id generic_simple_bus_ids[] = {
  57. { .compatible = "simple-bus" },
  58. { .compatible = "simple-mfd" },
  59. { }
  60. };
  61. #endif
  62. U_BOOT_DRIVER(simple_bus) = {
  63. .name = "simple_bus",
  64. .id = UCLASS_SIMPLE_BUS,
  65. .of_match = of_match_ptr(generic_simple_bus_ids),
  66. .flags = DM_FLAG_PRE_RELOC,
  67. };