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 128 129 130 131 132 133 134 135 136 137 138 139 140 | // SPDX-License-Identifier: GPL-2.0+ /* * (C) Copyright 2023 Dzmitry Sankouski <dsankouski@gmail.com> */ #include <stdlib.h> #include <common.h> #include <dm.h> #include <fdtdec.h> #include <input.h> #include <keyboard.h> #include <button.h> #include <dm/device-internal.h> #include <log.h> #include <asm/io.h> #include <asm/gpio.h> #include <linux/delay.h> #include <linux/input.h> /** * struct button_kbd_priv - driver private data * * @input: input configuration * @button_size: number of buttons found * @old_state: a pointer to old button states array. Used to determine button state change. */ struct button_kbd_priv { struct input_config *input; u32 button_size; u32 *old_state; }; static int button_kbd_start(struct udevice *dev) { struct button_kbd_priv *priv = dev_get_priv(dev); int i = 0; struct udevice *button_gpio_devp, *next_devp; struct uclass *uc; uclass_foreach_dev_probe(UCLASS_BUTTON, button_gpio_devp) { struct button_uc_plat *uc_plat = dev_get_uclass_plat(button_gpio_devp); /* Ignore the top-level button node */ if (!uc_plat->label) continue; debug("Found button %s #%d - %s, probing...\n", uc_plat->label, i, button_gpio_devp->name); i++; } if (uclass_get(UCLASS_BUTTON, &uc)) return -ENOENT; /* * Unbind any buttons that failed to probe so we don't iterate over * them when polling. */ uclass_foreach_dev_safe(button_gpio_devp, next_devp, uc) { if (!(dev_get_flags(button_gpio_devp) & DM_FLAG_ACTIVATED)) { log_warning("Button %s failed to probe\n", button_gpio_devp->name); device_unbind(button_gpio_devp); } } priv->button_size = i; priv->old_state = calloc(i, sizeof(int)); return 0; } int button_read_keys(struct input_config *input) { struct button_kbd_priv *priv = dev_get_priv(input->dev); struct udevice *button_gpio_devp; struct uclass *uc; int i = 0; u32 code, state, state_changed = 0; uclass_id_foreach_dev(UCLASS_BUTTON, button_gpio_devp, uc) { struct button_uc_plat *uc_plat = dev_get_uclass_plat(button_gpio_devp); /* Ignore the top-level button node */ if (!uc_plat->label) continue; code = button_get_code(button_gpio_devp); if (!code) continue; state = button_get_state(button_gpio_devp); state_changed = state != priv->old_state[i]; if (state_changed) { debug("%s: %d\n", uc_plat->label, code); priv->old_state[i] = state; input_add_keycode(input, code, state); } i++; } return 0; } static const struct keyboard_ops button_kbd_ops = { .start = button_kbd_start, }; static int button_kbd_probe(struct udevice *dev) { struct button_kbd_priv *priv = dev_get_priv(dev); struct keyboard_priv *uc_priv = dev_get_uclass_priv(dev); struct stdio_dev *sdev = &uc_priv->sdev; struct input_config *input = &uc_priv->input; int ret = 0; input_init(input, false); input_add_tables(input, false); /* Register the device. */ priv->input = input; input->dev = dev; input->read_keys = button_read_keys; strcpy(sdev->name, "button-kbd"); ret = input_stdio_register(sdev); if (ret) { debug("%s: input_stdio_register() failed\n", __func__); return ret; } return 0; } U_BOOT_DRIVER(button_kbd) = { .name = "button_kbd", .id = UCLASS_KEYBOARD, .ops = &button_kbd_ops, .priv_auto = sizeof(struct button_kbd_priv), .probe = button_kbd_probe, }; U_BOOT_DRVINFO(button_kbd) = { .name = "button_kbd" }; |