This controller formats the data to a Wiegand format and bit-bangs the message on devicetree defined GPIO lines. Several attributes need to be defined in the devicetree in order for this driver to work, namely the data-hi-gpios, data-lo-gpios, pulse-len, frame-gap and interval-len. These attributes are documented in the devicetree bindings documentation files. The driver creates a dev file for writing messages on the bus. It also creates a sysfs file to control the payload length of messages(in bits). If a message is shorter than the set payload length, it will be discarded. On the other hand, if a message is longer, the additional bits will be stripped off. Acked-by: Linus Walleij <linus.walleij@xxxxxxxxxx> Signed-off-by: Martin Zaťovič <m.zatovic1@xxxxxxxxx> --- .../ABI/testing/sysfs-driver-wiegand-gpio | 9 + MAINTAINERS | 2 + drivers/wiegand/Kconfig | 8 + drivers/wiegand/Makefile | 1 + drivers/wiegand/wiegand-gpio.c | 189 ++++++++++++++++++ 5 files changed, 209 insertions(+) create mode 100644 Documentation/ABI/testing/sysfs-driver-wiegand-gpio create mode 100644 drivers/wiegand/wiegand-gpio.c diff --git a/Documentation/ABI/testing/sysfs-driver-wiegand-gpio b/Documentation/ABI/testing/sysfs-driver-wiegand-gpio new file mode 100644 index 000000000000..c3981972dbc8 --- /dev/null +++ b/Documentation/ABI/testing/sysfs-driver-wiegand-gpio @@ -0,0 +1,9 @@ +What: /sys/devices/platform/.../wiegand-gpio-attributes/payload_len +Date: May 2023 +Contact: Martin Zaťovič <m.zatovic1@xxxxxxxxx> +Description: + Read/set the payload length of messages sent by Wiegand GPIO + bit-banging controller in bits. The default value is 26, as + that is the most widely-used message length of Wiegand messages. + Controller will only send messages of at least the set length + and it will strip off bits of longer messages. diff --git a/MAINTAINERS b/MAINTAINERS index 915cb36e5b2f..e828a5ec8162 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -22707,7 +22707,9 @@ F: include/linux/wiegand.h WIEGAND GPIO BITBANG DRIVER M: Martin Zaťovič <m.zatovic1@xxxxxxxxx> S: Maintained +F: Documentation/ABI/testing/sysfs-driver-wiegand-gpio F: Documentation/devicetree/bindings/wiegand/wiegand-gpio.yaml +F: drivers/wiegand/wiegand-gpio.c WILOCITY WIL6210 WIRELESS DRIVER L: linux-wireless@xxxxxxxxxxxxxxx diff --git a/drivers/wiegand/Kconfig b/drivers/wiegand/Kconfig index fc99575bc3cc..9a8f705d4646 100644 --- a/drivers/wiegand/Kconfig +++ b/drivers/wiegand/Kconfig @@ -18,3 +18,11 @@ config WIEGAND are initially pulled up. When a bit of value 0 is being transmitted, the D0 line is pulled down. Similarly, when a bit of value 1 is being transmitted, the D1 line is pulled down. + +config WIEGAND_GPIO + tristate "GPIO-based wiegand master (write only)" + depends on WIEGAND + help + This GPIO bitbanging Wiegand controller uses the libgpiod library to + utilize GPIO lines for sending Wiegand data. Userspace may access + the Wiegand GPIO interface via a dev entry. diff --git a/drivers/wiegand/Makefile b/drivers/wiegand/Makefile index d17ecb722c6e..ddf697e21088 100644 --- a/drivers/wiegand/Makefile +++ b/drivers/wiegand/Makefile @@ -1 +1,2 @@ obj-$(CONFIG_WIEGAND) += wiegand.o +obj-$(CONFIG_WIEGAND_GPIO) += wiegand-gpio.o diff --git a/drivers/wiegand/wiegand-gpio.c b/drivers/wiegand/wiegand-gpio.c new file mode 100644 index 000000000000..a46421f515b1 --- /dev/null +++ b/drivers/wiegand/wiegand-gpio.c @@ -0,0 +1,189 @@ +// SPDX-License-Identifier: GPL-2.0-only + +#include <linux/delay.h> +#include <linux/gpio/consumer.h> +#include <linux/module.h> +#include <linux/platform_device.h> +#include <linux/poll.h> +#include <linux/slab.h> +#include <linux/wiegand.h> + +#define UP_TO_100_USEC_DEVIATION 1 +#define MORE_THAN_100_USEC_DEVIATION 3 + +struct wiegand_gpio { + struct device *dev; + struct wiegand_controller *ctlr; + struct gpio_desc *data1_gpio; + struct gpio_desc *data0_gpio; +}; + +static ssize_t store_ulong(u32 *val, const char *buf, size_t size, unsigned long max) +{ + int rc; + u32 new; + + rc = kstrtou32(buf, 0, &new); + if (rc) + return rc; + + if (new > max) + return -EINVAL; + + *val = new; + return size; +} + +/* + * Attribute file for setting payload length of Wiegand messages. + */ +static ssize_t payload_len_show(struct device *dev, struct device_attribute *attr, char *buf) +{ + struct wiegand_gpio *wiegand_gpio = dev_get_drvdata(dev); + struct wiegand_controller *ctlr = wiegand_gpio->ctlr; + + return sysfs_emit(buf, "%u\n", ctlr->payload_len); +} + +static ssize_t payload_len_store(struct device *dev, struct device_attribute *attr, const char *buf, + size_t count) +{ + struct wiegand_gpio *wiegand_gpio = dev_get_drvdata(dev); + struct wiegand_controller *ctlr = wiegand_gpio->ctlr; + + return store_ulong(&(ctlr->payload_len), buf, count, WIEGAND_MAX_PAYLEN_BYTES * 8); +} +static DEVICE_ATTR_RW(payload_len); + +static struct attribute *wiegand_gpio_attrs[] = { + &dev_attr_payload_len.attr, + NULL +}; +ATTRIBUTE_GROUPS(wiegand_gpio); + +/* + * To send a bit of value 1 following the wiegand protocol, one must set + * the wiegand_data_hi to low for the duration of pulse. Similarly to send + * a bit of value 0, the wiegand_data_lo is set to low for pulse duration. + * This way the two lines are never low at the same time. + */ +void wiegand_gpio_send_bit(struct wiegand_gpio *wiegand_gpio, bool value, bool last) +{ + u32 sleep_len; + u32 pulse_len = wiegand_gpio->ctlr->pulse_len; + u32 interval_len = wiegand_gpio->ctlr->interval_len; + u32 frame_gap = wiegand_gpio->ctlr->frame_gap; + struct gpio_desc *gpio = value ? wiegand_gpio->data1_gpio : wiegand_gpio->data0_gpio; + + gpiod_set_value_cansleep(gpio, 0); + udelay(pulse_len); + gpiod_set_value_cansleep(gpio, 1); + + if (last) + sleep_len = frame_gap - pulse_len; + else + sleep_len = interval_len - pulse_len; + + if (sleep_len < 10) + udelay(sleep_len); + else if (sleep_len < 100) + usleep_range(sleep_len - UP_TO_100_USEC_DEVIATION, + sleep_len + UP_TO_100_USEC_DEVIATION); + else + usleep_range(sleep_len - MORE_THAN_100_USEC_DEVIATION, + sleep_len + MORE_THAN_100_USEC_DEVIATION); +} + +static int wiegand_gpio_write_by_bits(struct wiegand_gpio *wiegand_gpio, u16 bitlen) +{ + size_t i; + bool bit_value, is_last_bit; + + for (i = 0; i < bitlen; i++) { + bit_value = test_bit(i, wiegand_gpio->ctlr->data_bitmap); + is_last_bit = (i + 1) == bitlen; + wiegand_gpio_send_bit(wiegand_gpio, bit_value, is_last_bit); + } + + return 0; +} + +int wiegand_gpio_transfer_message(struct wiegand_controller *ctlr) +{ + struct wiegand_gpio *wiegand_gpio = wiegand_primary_get_devdata(ctlr); + u8 msg_bitlen = ctlr->payload_len; + + wiegand_gpio_write_by_bits(wiegand_gpio, msg_bitlen); + + return 0; +} + +static int wiegand_gpio_request(struct device *dev, struct wiegand_gpio *wiegand_gpio) +{ + wiegand_gpio->data0_gpio = devm_gpiod_get(dev, "data-lo", GPIOD_OUT_HIGH); + if (IS_ERR(wiegand_gpio->data0_gpio)) + return PTR_ERR(wiegand_gpio->data0_gpio); + + wiegand_gpio->data1_gpio = devm_gpiod_get(dev, "data-hi", GPIOD_OUT_HIGH); + return PTR_ERR_OR_ZERO(wiegand_gpio->data1_gpio); +} + +static int wiegand_gpio_probe(struct platform_device *device) +{ + int status = 0; + struct wiegand_controller *primary; + struct wiegand_gpio *wiegand_gpio; + struct device *dev = &device->dev; + + primary = wiegand_alloc_controller(dev, sizeof(*wiegand_gpio), false); + if (!primary) + return -ENOMEM; + + primary->transfer_message = &wiegand_gpio_transfer_message; + primary->payload_len = 26; // set standard 26-bit format + + wiegand_gpio = wiegand_primary_get_devdata(primary); + wiegand_gpio->ctlr = primary; + + platform_set_drvdata(device, wiegand_gpio); + + primary->bus_num = device->id; + wiegand_gpio->dev = dev; + + status = wiegand_gpio_request(dev, wiegand_gpio); + if (status) + return dev_err_probe(wiegand_gpio->dev, status, "failed at requesting GPIOs\n"); + + status = gpiod_direction_output(wiegand_gpio->data1_gpio, 1); + if (status) + return dev_err_probe(wiegand_gpio->dev, status, "failed to set GPIOs direction\n"); + + status = gpiod_direction_output(wiegand_gpio->data0_gpio, 1); + if (status) + return dev_err_probe(wiegand_gpio->dev, status, "failed to set GPIOs direction\n"); + + status = wiegand_register_controller(primary); + if (status) + dev_err_probe(wiegand_gpio->dev, status, "failed to register primary\n"); + return status; +} + +static const struct of_device_id wiegand_gpio_dt_idtable[] = { + { .compatible = "wiegand-gpio", }, + {} +}; +MODULE_DEVICE_TABLE(of, wiegand_gpio_dt_idtable); + +static struct platform_driver wiegand_gpio_driver = { + .driver = { + .name = "wiegand-gpio", + .of_match_table = wiegand_gpio_dt_idtable, + .dev_groups = wiegand_gpio_groups + }, + .probe = wiegand_gpio_probe +}; +module_platform_driver(wiegand_gpio_driver); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Wiegand write-only driver realized by GPIOs"); +MODULE_AUTHOR("Martin Zaťovič <m.zatovic1@xxxxxxxxx>"); -- 2.40.0