reboot-mode-gpio.c 2.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (c), Vaisala Oyj
  4. */
  5. #include <common.h>
  6. #include <asm/gpio.h>
  7. #include <dm.h>
  8. #include <dm/devres.h>
  9. #include <errno.h>
  10. #include <reboot-mode/reboot-mode-gpio.h>
  11. #include <reboot-mode/reboot-mode.h>
  12. DECLARE_GLOBAL_DATA_PTR;
  13. static int reboot_mode_get(struct udevice *dev, u32 *buf)
  14. {
  15. int ret;
  16. struct reboot_mode_gpio_platdata *plat_data;
  17. if (!buf)
  18. return -EINVAL;
  19. plat_data = dev_get_plat(dev);
  20. if (!plat_data)
  21. return -EINVAL;
  22. ret = dm_gpio_get_values_as_int(plat_data->gpio_desc,
  23. plat_data->gpio_count);
  24. if (ret < 0)
  25. return ret;
  26. *buf = ret;
  27. return 0;
  28. }
  29. static int reboot_mode_probe(struct udevice *dev)
  30. {
  31. struct reboot_mode_gpio_platdata *plat_data;
  32. plat_data = dev_get_plat(dev);
  33. if (!plat_data)
  34. return -EINVAL;
  35. int ret;
  36. #if CONFIG_IS_ENABLED(OF_CONTROL)
  37. ret = gpio_get_list_count(dev, "gpios");
  38. if (ret < 0)
  39. return ret;
  40. plat_data->gpio_count = ret;
  41. #endif
  42. if (plat_data->gpio_count <= 0)
  43. return -EINVAL;
  44. plat_data->gpio_desc = devm_kcalloc(dev, plat_data->gpio_count,
  45. sizeof(struct gpio_desc), 0);
  46. if (!plat_data->gpio_desc)
  47. return -ENOMEM;
  48. #if CONFIG_IS_ENABLED(OF_CONTROL)
  49. ret = gpio_request_list_by_name(dev, "gpios", plat_data->gpio_desc,
  50. plat_data->gpio_count, GPIOD_IS_IN);
  51. if (ret < 0)
  52. return ret;
  53. #else
  54. for (int i = 0; i < plat_data->gpio_count; i++) {
  55. struct reboot_mode_gpio_config *gpio =
  56. plat_data->gpios_config + i;
  57. struct gpio_desc *desc = plat_data->gpio_desc + i;
  58. ret = uclass_get_device_by_seq(UCLASS_GPIO,
  59. gpio->gpio_dev_offset,
  60. &desc->dev);
  61. if (ret < 0)
  62. return ret;
  63. desc->flags = gpio->flags;
  64. desc->offset = gpio->gpio_offset;
  65. ret = dm_gpio_request(desc, "");
  66. if (ret < 0)
  67. return ret;
  68. ret = dm_gpio_set_dir(desc);
  69. if (ret < 0)
  70. return ret;
  71. }
  72. #endif
  73. return 0;
  74. }
  75. static int reboot_mode_remove(struct udevice *dev)
  76. {
  77. struct reboot_mode_gpio_platdata *plat_data;
  78. plat_data = dev_get_plat(dev);
  79. if (!plat_data)
  80. return -EINVAL;
  81. return gpio_free_list(dev, plat_data->gpio_desc, plat_data->gpio_count);
  82. }
  83. #if CONFIG_IS_ENABLED(OF_CONTROL)
  84. static const struct udevice_id reboot_mode_ids[] = {
  85. { .compatible = "reboot-mode-gpio", 0 },
  86. { }
  87. };
  88. #endif
  89. static const struct reboot_mode_ops reboot_mode_gpio_ops = {
  90. .get = reboot_mode_get,
  91. };
  92. U_BOOT_DRIVER(reboot_mode_gpio) = {
  93. .name = "reboot-mode-gpio",
  94. .id = UCLASS_REBOOT_MODE,
  95. .probe = reboot_mode_probe,
  96. .remove = reboot_mode_remove,
  97. #if CONFIG_IS_ENABLED(OF_CONTROL)
  98. .of_match = reboot_mode_ids,
  99. #endif
  100. .plat_auto = sizeof(struct reboot_mode_gpio_platdata),
  101. .ops = &reboot_mode_gpio_ops,
  102. };