pci-emul-uclass.c 1.5 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (c) 2014 Google, Inc
  4. * Written by Simon Glass <sjg@chromium.org>
  5. */
  6. #include <common.h>
  7. #include <dm.h>
  8. #include <fdtdec.h>
  9. #include <linux/libfdt.h>
  10. #include <pci.h>
  11. #include <dm/lists.h>
  12. struct sandbox_pci_emul_priv {
  13. int dev_count;
  14. };
  15. int sandbox_pci_get_emul(struct udevice *bus, pci_dev_t find_devfn,
  16. struct udevice **containerp, struct udevice **emulp)
  17. {
  18. struct udevice *dev;
  19. int ret;
  20. *containerp = NULL;
  21. ret = pci_bus_find_devfn(bus, PCI_MASK_BUS(find_devfn), &dev);
  22. if (ret) {
  23. debug("%s: Could not find emulator for dev %x\n", __func__,
  24. find_devfn);
  25. return ret;
  26. }
  27. *containerp = dev;
  28. if (device_get_uclass_id(dev) == UCLASS_PCI_GENERIC) {
  29. ret = device_find_first_child(dev, emulp);
  30. if (ret)
  31. return ret;
  32. } else {
  33. *emulp = dev;
  34. }
  35. return *emulp ? 0 : -ENODEV;
  36. }
  37. static int sandbox_pci_emul_post_probe(struct udevice *dev)
  38. {
  39. struct sandbox_pci_emul_priv *priv = dev->uclass->priv;
  40. priv->dev_count++;
  41. sandbox_set_enable_pci_map(true);
  42. return 0;
  43. }
  44. static int sandbox_pci_emul_pre_remove(struct udevice *dev)
  45. {
  46. struct sandbox_pci_emul_priv *priv = dev->uclass->priv;
  47. priv->dev_count--;
  48. sandbox_set_enable_pci_map(priv->dev_count > 0);
  49. return 0;
  50. }
  51. UCLASS_DRIVER(pci_emul) = {
  52. .id = UCLASS_PCI_EMUL,
  53. .name = "pci_emul",
  54. .post_probe = sandbox_pci_emul_post_probe,
  55. .pre_remove = sandbox_pci_emul_pre_remove,
  56. .priv_auto_alloc_size = sizeof(struct sandbox_pci_emul_priv),
  57. };