simple-pm-bus.c 1.1 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (C) 2020 Sean Anderson <seanga2@gmail.com>
  4. */
  5. #include <common.h>
  6. #include <clk.h>
  7. #include <dm.h>
  8. /*
  9. * Power domains are taken care of by driver_probe, so we just have to enable
  10. * clocks
  11. */
  12. static int simple_pm_bus_probe(struct udevice *dev)
  13. {
  14. int ret;
  15. struct clk_bulk *bulk = dev_get_priv(dev);
  16. ret = clk_get_bulk(dev, bulk);
  17. if (ret)
  18. return ret;
  19. ret = clk_enable_bulk(bulk);
  20. if (ret && ret != -ENOSYS && ret != -ENOTSUPP) {
  21. clk_release_bulk(bulk);
  22. return ret;
  23. }
  24. return 0;
  25. }
  26. static int simple_pm_bus_remove(struct udevice *dev)
  27. {
  28. int ret;
  29. struct clk_bulk *bulk = dev_get_priv(dev);
  30. ret = clk_release_bulk(bulk);
  31. if (ret && ret != -ENOSYS && ret != -ENOTSUPP)
  32. return ret;
  33. else
  34. return 0;
  35. }
  36. static const struct udevice_id simple_pm_bus_ids[] = {
  37. { .compatible = "simple-pm-bus" },
  38. { }
  39. };
  40. U_BOOT_DRIVER(simple_pm_bus_drv) = {
  41. .name = "simple_pm_bus",
  42. .id = UCLASS_SIMPLE_BUS,
  43. .of_match = simple_pm_bus_ids,
  44. .probe = simple_pm_bus_probe,
  45. .remove = simple_pm_bus_remove,
  46. .priv_auto_alloc_size = sizeof(struct clk_bulk),
  47. .flags = DM_FLAG_PRE_RELOC,
  48. };