syscon-uclass.c 1.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273
  1. /*
  2. * Copyright (C) 2015 Google, Inc
  3. * Written by Simon Glass <sjg@chromium.org>
  4. *
  5. * SPDX-License-Identifier: GPL-2.0+
  6. */
  7. #include <common.h>
  8. #include <syscon.h>
  9. #include <dm.h>
  10. #include <errno.h>
  11. #include <regmap.h>
  12. #include <dm/device-internal.h>
  13. #include <dm/lists.h>
  14. #include <dm/root.h>
  15. #include <linux/err.h>
  16. struct regmap *syscon_get_regmap(struct udevice *dev)
  17. {
  18. struct syscon_uc_info *priv = dev_get_uclass_priv(dev);
  19. return priv->regmap;
  20. }
  21. static int syscon_pre_probe(struct udevice *dev)
  22. {
  23. struct syscon_uc_info *priv = dev_get_uclass_priv(dev);
  24. return regmap_init_mem(dev, &priv->regmap);
  25. }
  26. struct regmap *syscon_get_regmap_by_driver_data(ulong driver_data)
  27. {
  28. struct udevice *dev;
  29. struct uclass *uc;
  30. int ret;
  31. ret = uclass_get(UCLASS_SYSCON, &uc);
  32. if (ret)
  33. return ERR_PTR(ret);
  34. uclass_foreach_dev(dev, uc) {
  35. if (dev->driver_data == driver_data) {
  36. struct syscon_uc_info *priv;
  37. int ret;
  38. ret = device_probe(dev);
  39. if (ret)
  40. return ERR_PTR(ret);
  41. priv = dev_get_uclass_priv(dev);
  42. return priv->regmap;
  43. }
  44. }
  45. return ERR_PTR(-ENOENT);
  46. }
  47. void *syscon_get_first_range(ulong driver_data)
  48. {
  49. struct regmap *map;
  50. map = syscon_get_regmap_by_driver_data(driver_data);
  51. if (IS_ERR(map))
  52. return map;
  53. return regmap_get_range(map, 0);
  54. }
  55. UCLASS_DRIVER(syscon) = {
  56. .id = UCLASS_SYSCON,
  57. .name = "syscon",
  58. .per_device_auto_alloc_size = sizeof(struct syscon_uc_info),
  59. .pre_probe = syscon_pre_probe,
  60. };