axi-emul-uclass.c 1.7 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2018
  4. * Mario Six, Guntermann & Drunck GmbH, mario.six@gdsys.cc
  5. */
  6. #include <common.h>
  7. #include <axi.h>
  8. #include <dm.h>
  9. #include <log.h>
  10. #include <dm/device-internal.h>
  11. #include <asm/axi.h>
  12. int axi_sandbox_get_emul(struct udevice *bus, ulong address,
  13. enum axi_size_t size, struct udevice **emulp)
  14. {
  15. struct udevice *dev;
  16. u32 reg[2];
  17. uint offset;
  18. switch (size) {
  19. case AXI_SIZE_8:
  20. offset = 1;
  21. break;
  22. case AXI_SIZE_16:
  23. offset = 2;
  24. break;
  25. case AXI_SIZE_32:
  26. offset = 4;
  27. break;
  28. default:
  29. debug("%s: Unknown AXI transfer size '%d'", bus->name, size);
  30. offset = 0;
  31. }
  32. /*
  33. * Note: device_find_* don't activate the devices; they're activated
  34. * as-needed below.
  35. */
  36. for (device_find_first_child(bus, &dev);
  37. dev;
  38. device_find_next_child(&dev)) {
  39. int ret;
  40. ret = dev_read_u32_array(dev, "reg", reg, ARRAY_SIZE(reg));
  41. if (ret) {
  42. debug("%s: Could not read 'reg' property of %s\n",
  43. bus->name, dev->name);
  44. continue;
  45. }
  46. /*
  47. * Does the transfer's address fall into this device's address
  48. * space?
  49. */
  50. if (address >= reg[0] && address <= reg[0] + reg[1] - offset) {
  51. /* If yes, activate it... */
  52. if (device_probe(dev)) {
  53. debug("%s: Could not activate %s\n",
  54. bus->name, dev->name);
  55. return -ENODEV;
  56. }
  57. /* ...and return it */
  58. *emulp = dev;
  59. return 0;
  60. }
  61. }
  62. return -ENODEV;
  63. }
  64. int axi_get_store(struct udevice *dev, u8 **storep)
  65. {
  66. struct axi_emul_ops *ops = axi_emul_get_ops(dev);
  67. if (!ops->get_store)
  68. return -ENOSYS;
  69. return ops->get_store(dev, storep);
  70. }
  71. UCLASS_DRIVER(axi_emul) = {
  72. .id = UCLASS_AXI_EMUL,
  73. .name = "axi_emul",
  74. };