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