axi-emul-uclass.c 1.6 KB

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