Message ID | 20240527144054.155503-1-brgl@bgdev.pl |
---|---|
State | New |
Headers | show |
Series | [v7] gpio: virtuser: new virtual driver | expand |
On Mon, May 27, 2024 at 04:40:54PM +0200, Bartosz Golaszewski wrote: > +static ssize_t > +gpio_virtuser_sysfs_consumer_store(struct device *dev, > + struct device_attribute *attr, > + const char *buf, size_t len) > +{ > + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); > + int ret; > + > + if (strlen(buf) > GPIO_CONSUMER_NAME_MAX_LEN) ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^ This is off by one. strlen() doesn't count the NUL terminator. > + return -EINVAL; > + > + guard(mutex)(&data->consumer_lock); > + > + ret = gpiod_set_consumer_name(data->desc, buf); > + if (ret) > + return ret; > + > + sprintf(data->consumer, buf); ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^ It results in a buffer overflow here. > + > + return len; > +} regards, dan carpenter
Mon, May 27, 2024 at 04:40:54PM +0200, Bartosz Golaszewski kirjoitti: > From: Bartosz Golaszewski <bartosz.golaszewski@linaro.org> > > The GPIO subsystem used to have a serious problem with undefined behavior > and use-after-free bugs on hot-unplug of GPIO chips. This can be > considered a corner-case by some as most GPIO controllers are enabled > early in the boot process and live until the system goes down but most > GPIO drivers do allow unbind over sysfs, many are loadable modules that > can be (force) unloaded and there are also GPIO devices that can be > dynamically detached, for instance CP2112 which is a USB GPIO expender. > > Bugs can be triggered both from user-space as well as by in-kernel users. > We have the means of testing it from user-space via the character device > but the issues manifest themselves differently in the kernel. > > This is a proposition of adding a new virtual driver - a configurable > GPIO consumer that can be configured over configfs (similarly to > gpio-sim) or described on the device-tree. > > This driver is aimed as a helper in spotting any regressions in > hot-unplug handling in GPIOLIB. ... > User must pass exactly the number of values that the array contains Can't we assume non-active values for the rest if less than needed were provided? For more than that, why do we care? ... > +#include <linux/atomic.h> > +#include <linux/bitmap.h> > +#include <linux/cleanup.h> > +#include <linux/completion.h> > +#include <linux/configfs.h> > +#include <linux/device.h> > +#include <linux/err.h> > +#include <linux/gpio/consumer.h> > +#include <linux/gpio/driver.h> > +#include <linux/gpio/machine.h> > +#include <linux/idr.h> > +#include <linux/interrupt.h> > +#include <linux/irq_work.h> > +#include <linux/kernel.h> Do you need this? > +#include <linux/limits.h> > +#include <linux/list.h> > +#include <linux/lockdep.h> > +#include <linux/mod_devicetable.h> > +#include <linux/module.h> > +#include <linux/mutex.h> > +#include <linux/notifier.h> > +#include <linux/of.h> > +#include <linux/overflow.h> > +#include <linux/platform_device.h> > +#include <linux/printk.h> > +#include <linux/property.h> > +#include <linux/slab.h> > +#include <linux/string.h> Implied by string_helpers.h > +#include <linux/string_helpers.h> > +#include <linux/sysfs.h> > +#include <linux/types.h> ... > +struct gpio_virtuser_line_array_data { > + struct gpio_descs *descs; > + struct kobject *kobj; > + struct attribute_group *attr_group; > +}; > + > +struct gpio_virtuser_line_data { > + struct gpio_desc *desc; > + struct kobject *kobj; > + struct attribute_group *attr_group; > + char consumer[GPIO_CONSUMER_NAME_MAX_LEN]; > + struct mutex consumer_lock; > + unsigned int debounce; > + atomic_t irq; > + atomic_t irq_count; > +}; Maybe struct gpio_virtuser_sysfs_data { union { struct gpio_desc *desc; struct gpio_descs *descs; }; struct kobject *kobj; struct attribute_group *attr_group; }; struct gpio_virtuser_line_array_data { struct gpio_virtuser_sysfs_data sd; }; struct gpio_virtuser_line_data { struct gpio_virtuser_sysfs_data sd; char consumer[GPIO_CONSUMER_NAME_MAX_LEN]; struct mutex consumer_lock; unsigned int debounce; atomic_t irq; atomic_t irq_count; }; ? ... > +struct gpio_virtuser_attr_ctx { > + struct device_attribute dev_attr; > + void *data; > +}; struct dev_ext_attribute ? ... > +struct gpio_virtuser_attr_descr { > + const char *name; > + ssize_t (*show)(struct device *, struct device_attribute *, char *); > + ssize_t (*store)(struct device *, struct device_attribute *, > + const char *, size_t); > +}; struct device_attribute ? (Yes, I know that that one is a bit bigger but benefit is that we have some code that you may reuse) ... > +static ssize_t gpio_virtuser_sysfs_emit_value_array(char *buf, > + unsigned long *values, > + size_t num_values) > +{ > + ssize_t len = 0; > + size_t i; > + > + for (i = 0; i < num_values; i++) > + len += sysfs_emit_at(buf, len, "%d", > + test_bit(i, values) ? 1 : 0); > + return len + sysfs_emit_at(buf, len, "\n"); Why not use %pb? > +} ... > +static int gpio_virtuser_sysfs_parse_value_array(const char *buf, size_t len, > + unsigned long *values) > +{ > + size_t i; > + > + for (i = 0; i < len; i++) { Perhaps bool val; int ret; ret = kstrtobool(...); if (ret) return ret; assign_bit(...); // btw, why atomic? > + if (buf[i] == '0') > + clear_bit(i, values); > + else if (buf[i] == '1') > + set_bit(i, values); > + else > + return -EINVAL; > + } BUT, why not bitmap_parse()? > + return 0; > +} ... > + unsigned long *values __free(bitmap) = bitmap_alloc(descs->ndescs, > + GFP_KERNEL); Perhaps unsigned long *values __free(bitmap) = bitmap_alloc(descs->ndescs, GFP_KERNEL); ... > + unsigned long *values __free(bitmap) = bitmap_zalloc(descs->ndescs, > + GFP_KERNEL); In the similar way? ... > + unsigned long *values __free(bitmap) = bitmap_zalloc(descs->ndescs, > + GFP_KERNEL); Ditto. ... > +{ > + return sysfs_emit(buf, "%s\n", > + dir == GPIO_LINE_DIRECTION_IN ? "input" : "output"); I think this maybe transformed to something like str_input_output() in string_choices.h (and you don't even need to include that as it's implied by string_helpers.h) > +} ... > +static int gpio_virtuser_parse_direction(const char *buf, int *dir, int *val) > +{ > + if (sysfs_streq(buf, "input")) { > + *dir = GPIO_LINE_DIRECTION_IN; > + return 0; > + } > + > + if (sysfs_streq(buf, "output-high")) > + *val = 1; > + else if (sysfs_streq(buf, "output-low")) > + *val = 0; > + else > + return -EINVAL; > + > + *dir = GPIO_LINE_DIRECTION_OUT; This can be transformed to use sysfs_match_string() with static const char * const dirs[] = { "output-low", "output-high", "input" }; int ret; ret = sysfs_match_string(...); if (ret < 0) return ret; *val = ret; *dir = ret == 2 ? GPIO_LINE_DIRECTION_IN : GPIO_LINE_DIRECTION_OUT; And with this approach it even not clear why do you need dir and val to be separated here (esp. if we add a enum like GPIO_VIRTUSER_OUT_LOW, GPIO_VIRTUSER_OUT_HIGH, GPIO_VIRTUSER_IN, (with it the string array can also be indexed). > + return 0; > +} ... > +static int gpio_virtuser_parse_value(const char *buf) > +{ > + int value, ret; > + > + value = sysfs_match_string(gpio_virtuser_sysfs_value_strings, buf); > + if (value < 0) { > + /* Can be 0 or 1 too. */ > + ret = kstrtoint(buf, 0, &value); > + if (ret) > + return ret; > + if (value != 0 && value != 1) > + return -EINVAL; Why not kstrtobool()? > + } > + > + return value; > +} ... > + ret = kstrtouint(buf, 10, &debounce); Why restrict to decimal? > + if (ret) > + return ret; ... > +static ssize_t > +gpio_virtuser_sysfs_consumer_store(struct device *dev, > + struct device_attribute *attr, > + const char *buf, size_t len) > +{ > + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); > + int ret; > + if (strlen(buf) > GPIO_CONSUMER_NAME_MAX_LEN) > + return -EINVAL; You don't need this if you use strscpy() below and check its returned value. > + guard(mutex)(&data->consumer_lock); > + > + ret = gpiod_set_consumer_name(data->desc, buf); > + if (ret) > + return ret; > + > + sprintf(data->consumer, buf); > + > + return len; > +} ... > + data->attr_group->name = devm_kasprintf(dev, GFP_KERNEL, > + "gpiod:%s", id); Why two lines? > + if (!data->attr_group->name) > + return -ENOMEM; ... > + ret = devm_add_action_or_reset(dev, gpio_virtuser_mutex_destroy, > + &data->consumer_lock); Don't we have devm_mutex_init() (`git tag --contains` shows v6.10-rc1 to me) > + return ret; ... > +static int gpio_virtuser_prop_is_gpio(struct property *prop) > +{ > + char *dash = strpbrk(prop->name, "-"); Why not strrchr() ? > + return dash && strcmp(dash, "-gpios") == 0; Can't we reuse the suffix from the array from the gpiolib internal header? Also I don't like the form of '-' in the line. "gpios" is good and chance that linker deduplicates the same string if it occurs somewhere else in the binary (in case this goes with =y in .config). > +} ... > +/* > + * If this is an OF-based system, then we iterate over properties and consider > + * all whose names end in "-gpios". For configfs we expect an additional string > + * array property - "gpio-virtuser,ids" - containing the list of all GPIO IDs > + * to request. Why not any other system? What's wrong for having this available for ACPI, for example? Okay, I see that this is probably due to absence of API. OTOH the last call in the function assumes non-OF cases. Why can't we have the same approach in both? > + */ > +static int gpio_virtuser_count_ids(struct device *dev) > +{ > + struct fwnode_handle *fwnode = dev_fwnode(dev); Why? This function is mostly OF one, make it simpler. struct device_node *np = dev_of_node(dev); > + struct property *prop; > + int ret = 0; > + if (is_of_node(fwnode)) { Instead of this check... if (np) { ...can be used. > + for_each_property_of_node(to_of_node(fwnode), prop) { for_each_property_of_node(np, prop) { > + if (gpio_virtuser_prop_is_gpio(prop)) > + ++ret; Why pre-increment? > + } > + return ret; > + } > + return device_property_string_array_count(dev, "gpio-virtuser,ids"); > +} ... > +static int gpio_virtuser_get_ids(struct device *dev, const char **ids, > + int num_ids) > +{ > + struct fwnode_handle *fwnode = dev_fwnode(dev); > + struct property *prop; > + size_t pos = 0, diff; > + char *dash, *tmp; > + > + if (is_of_node(fwnode)) { > + for_each_property_of_node(to_of_node(fwnode), prop) { As per above function. > + if (!gpio_virtuser_prop_is_gpio(prop)) > + continue; > + > + dash = strpbrk(prop->name, "-"); > + diff = dash - prop->name; > + > + tmp = devm_kmemdup(dev, prop->name, diff + 1, > + GFP_KERNEL); devm_kstrndup() is not okay? Okay, we don't have it (yet?), but at least I would rather expect wrapped kstrndup() than this. > + if (!tmp) > + return -ENOMEM; > + > + tmp[diff] = '\0'; > + ids[pos++] = tmp; > + } > + > + return 0; > + } > + > + return device_property_read_string_array(dev, "gpio-virtuser,ids", > + ids, num_ids); > +} ... > +static int gpio_virtuser_probe(struct platform_device *pdev) > +{ > + struct device *dev = &pdev->dev; > + struct gpio_descs *descs; > + int ret, num_ids = 0, i; > + const char **ids; > + unsigned int j; > + > + num_ids = gpio_virtuser_count_ids(dev); > + if (num_ids < 0) > + return dev_err_probe(dev, num_ids, > + "Failed to get the number of GPIOs to request\n"); > + > + if (num_ids == 0) { > + dev_err(dev, "No GPIO IDs specified\n"); > + return -EINVAL; It's okay to return dev_err_probe(...); with know error code. > + } > + > + ids = devm_kcalloc(dev, num_ids, sizeof(*ids), GFP_KERNEL); > + if (!ids) > + return -ENOMEM; > + > + ret = gpio_virtuser_get_ids(dev, ids, num_ids); > + if (ret < 0) > + return dev_err_probe(dev, ret, > + "Failed to get the IDs of GPIOs to request\n"); > + > + for (i = 0; i < num_ids; i++) { > + descs = devm_gpiod_get_array(dev, ids[i], GPIOD_ASIS); > + if (IS_ERR(descs)) > + return dev_err_probe(dev, PTR_ERR(descs), > + "Failed to request the '%s' GPIOs\n", > + ids[i]); > + > + ret = gpio_virtuser_sysfs_init_line_array_attrs(dev, descs, > + ids[i]); > + if (ret) > + return dev_err_probe(dev, ret, > + "Failed to setup the sysfs array interface for the '%s' GPIOs\n", > + ids[i]); > + > + for (j = 0; j < descs->ndescs; j++) { > + ret = gpio_virtuser_sysfs_init_line_attrs(dev, > + descs->desc[j], > + ids[i], j); > + if (ret) > + return dev_err_probe(dev, ret, > + "Failed to setup the sysfs line interface for the '%s' GPIOs\n", > + ids[i]); > + } > + } > + > + return 0; > +} ... > +static int gpio_virtuser_bus_notifier_call(struct notifier_block *nb, > + unsigned long action, void *data) > +{ > + struct gpio_virtuser_device *vdev; > + struct device *dev = data; > + char devname[32]; > + > + vdev = container_of(nb, struct gpio_virtuser_device, bus_notifier); > + snprintf(devname, sizeof(devname), "gpio-virtuser.%d", vdev->id); > + > + if (strcmp(dev_name(dev), devname)) if (!device_match_name(...)) > + return NOTIFY_DONE; > + > + switch (action) { > + case BUS_NOTIFY_BOUND_DRIVER: > + vdev->driver_bound = true; > + break; > + case BUS_NOTIFY_DRIVER_NOT_BOUND: > + vdev->driver_bound = false; > + break; > + default: > + return NOTIFY_DONE; > + } > + > + complete(&vdev->probe_completion); > + return NOTIFY_OK; > +} ... > +static ssize_t > +gpio_virtuser_lookup_entry_config_key_store(struct config_item *item, > + const char *page, size_t count) > +{ > + struct gpio_virtuser_lookup_entry *entry = > + to_gpio_virtuser_lookup_entry(item); > + struct gpio_virtuser_device *dev = entry->parent->parent; > + > + char *key = kstrndup(skip_spaces(page), count, GFP_KERNEL); Missing __free() ? > + if (!key) > + return -ENOMEM; > + strim(key); > + guard(mutex)(&dev->lock); > + > + if (gpio_virtuser_device_is_live(dev)) > + return -EBUSY; > + > + kfree(entry->key); > + entry->key = no_free_ptr(key); > + > + return count; > +} ... > + if (sysfs_streq(page, "pull-up")) { > + entry->flags &= ~(GPIO_PULL_DOWN | GPIO_PULL_DISABLE); > + entry->flags |= GPIO_PULL_UP; > + } else if (sysfs_streq(page, "pull-down")) { > + entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DISABLE); > + entry->flags |= GPIO_PULL_DOWN; > + } else if (sysfs_streq(page, "pull-disabled")) { > + entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DOWN); > + entry->flags |= GPIO_PULL_DISABLE; > + } else if (sysfs_streq(page, "as-is")) { > + entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DOWN | > + GPIO_PULL_DISABLE); > + } else { > + count = -EINVAL; return -EINVAL won't (ab)use count semantics. > + } > + > + return count; ... > + return sprintf(page, "%s\n", flags & GPIO_ACTIVE_LOW ? "1" : "0"); Somewhere above you used %d for very similar situation, why %s here? Or why "5d" there? ... > + return sprintf(page, "%s\n", flags & GPIO_TRANSITORY ? "1" : "0"); Ditto. ... > + return sprintf(page, "%c\n", live ? '1' : '0'); Wow! Third type of the same. ... > + struct gpiod_lookup_table *table __free(kfree) = > + kzalloc(struct_size(table, table, num_entries + 1), GFP_KERNEL); > + if (!table) > + return -ENOMEM; > + table->dev_id = kasprintf(GFP_KERNEL, "gpio-virtuser.%d", > + dev->id); Perfectly one line in comparison with the few lines above). > + if (!table->dev_id) > + return -ENOMEM; ... > + curr->chip_hwnum = entry->offset < 0 > + ? U16_MAX : entry->offset; Can we leave ? on the previous line? ... > + ++i; Why pre-increment? ... > +static struct fwnode_handle * > +gpio_virtuser_make_device_swnode(struct gpio_virtuser_device *dev) > +{ > + struct property_entry properties[2]; > + struct gpio_virtuser_lookup *lookup; > + size_t num_ids; > + int i = 0; Why signed? And in all this kind of case, I would split assignment... > + memset(properties, 0, sizeof(properties)); > + > + num_ids = list_count_nodes(&dev->lookup_list); > + char **ids __free(kfree) = kcalloc(num_ids + 1, sizeof(*ids), > + GFP_KERNEL); > + if (!ids) > + return ERR_PTR(-ENOMEM); > + To be here, that the reader will see immediately (close enough) what is the initial values. Moreover this code will be robuse against changes in between (if i become reusable). > + list_for_each_entry(lookup, &dev->lookup_list, siblings) > + ids[i++] = lookup->con_id; > + > + properties[0] = PROPERTY_ENTRY_STRING_ARRAY_LEN("gpio-virtuser,ids", > + ids, num_ids); > + > + return fwnode_create_software_node(properties, NULL); > +} ... > + guard(mutex)(&dev->lock); > + > + if (live == gpio_virtuser_device_is_live(dev)) > + ret = -EPERM; With guard in place, just return directly, ... > + else if (live) ...drop 'else'... > + ret = gpio_virtuser_device_activate(dev); > + else ...ditto... > + gpio_virtuser_device_deactivate(dev); > + > + return ret ?: count; ...and simply return count here. ... > + struct gpio_virtuser_device *dev __free(kfree) = kzalloc(sizeof(*dev), > + GFP_KERNEL); struct gpio_virtuser_device *dev __free(kfree) = kzalloc(sizeof(*dev), GFP_KERNEL); > + if (!dev) > + return ERR_PTR(-ENOMEM); ... > + ret = platform_driver_register(&gpio_virtuser_driver); > + if (ret) { > + pr_err("Failed to register the platform driver: %d\n", > + ret); I would keep one line. > + return ret; > + }
On Wed, May 29, 2024 at 11:00 PM Andy Shevchenko <andy.shevchenko@gmail.com> wrote: > > Mon, May 27, 2024 at 04:40:54PM +0200, Bartosz Golaszewski kirjoitti: > > From: Bartosz Golaszewski <bartosz.golaszewski@linaro.org> > > > > The GPIO subsystem used to have a serious problem with undefined behavior > > and use-after-free bugs on hot-unplug of GPIO chips. This can be > > considered a corner-case by some as most GPIO controllers are enabled > > early in the boot process and live until the system goes down but most > > GPIO drivers do allow unbind over sysfs, many are loadable modules that > > can be (force) unloaded and there are also GPIO devices that can be > > dynamically detached, for instance CP2112 which is a USB GPIO expender. > > > > Bugs can be triggered both from user-space as well as by in-kernel users. > > We have the means of testing it from user-space via the character device > > but the issues manifest themselves differently in the kernel. > > > > This is a proposition of adding a new virtual driver - a configurable > > GPIO consumer that can be configured over configfs (similarly to > > gpio-sim) or described on the device-tree. > > > > This driver is aimed as a helper in spotting any regressions in > > hot-unplug handling in GPIOLIB. > > ... > > > User must pass exactly the number of values that the array contains > > Can't we assume non-active values for the rest if less than needed were > provided? For more than that, why do we care? > Honestly, what good would it do? It would just be more confusing IMO. > ... > > > +#include <linux/atomic.h> > > +#include <linux/bitmap.h> > > +#include <linux/cleanup.h> > > +#include <linux/completion.h> > > +#include <linux/configfs.h> > > +#include <linux/device.h> > > +#include <linux/err.h> > > +#include <linux/gpio/consumer.h> > > +#include <linux/gpio/driver.h> > > +#include <linux/gpio/machine.h> > > > +#include <linux/idr.h> > > > +#include <linux/interrupt.h> > > +#include <linux/irq_work.h> > > > +#include <linux/kernel.h> > > Do you need this? ARRAY_SIZE() used to live here when I first wrote this but it was since moved. I'll drop this. > > > +#include <linux/limits.h> > > +#include <linux/list.h> > > +#include <linux/lockdep.h> > > +#include <linux/mod_devicetable.h> > > +#include <linux/module.h> > > +#include <linux/mutex.h> > > +#include <linux/notifier.h> > > +#include <linux/of.h> > > +#include <linux/overflow.h> > > +#include <linux/platform_device.h> > > +#include <linux/printk.h> > > +#include <linux/property.h> > > +#include <linux/slab.h> > > > +#include <linux/string.h> > > Implied by string_helpers.h > Yeah, but we still use symbols directly from string.h, we shouldn't depend on implicit includes. > > +#include <linux/string_helpers.h> > > +#include <linux/sysfs.h> > > +#include <linux/types.h> > > ... > > > +struct gpio_virtuser_line_array_data { > > + struct gpio_descs *descs; > > + struct kobject *kobj; > > + struct attribute_group *attr_group; > > +}; > > + > > +struct gpio_virtuser_line_data { > > + struct gpio_desc *desc; > > + struct kobject *kobj; > > + struct attribute_group *attr_group; > > + char consumer[GPIO_CONSUMER_NAME_MAX_LEN]; > > + struct mutex consumer_lock; > > + unsigned int debounce; > > + atomic_t irq; > > + atomic_t irq_count; > > +}; > > Maybe > > struct gpio_virtuser_sysfs_data { > union { > struct gpio_desc *desc; > struct gpio_descs *descs; > }; > struct kobject *kobj; > struct attribute_group *attr_group; > }; > > struct gpio_virtuser_line_array_data { > struct gpio_virtuser_sysfs_data sd; > }; > > struct gpio_virtuser_line_data { > struct gpio_virtuser_sysfs_data sd; > char consumer[GPIO_CONSUMER_NAME_MAX_LEN]; > struct mutex consumer_lock; > unsigned int debounce; > atomic_t irq; > atomic_t irq_count; > }; > > ? > > ... > > > +struct gpio_virtuser_attr_ctx { > > + struct device_attribute dev_attr; > > + void *data; > > +}; > > struct dev_ext_attribute ? > Sounds good, I'll rework this. > ... > > > +struct gpio_virtuser_attr_descr { > > + const char *name; > > + ssize_t (*show)(struct device *, struct device_attribute *, char *); > > + ssize_t (*store)(struct device *, struct device_attribute *, > > + const char *, size_t); > > +}; > > struct device_attribute ? (Yes, I know that that one is a bit bigger but > benefit is that we have some code that you may reuse) > Not sure what you mean here, these are callbacks for sysfs. > ... > > > +static ssize_t gpio_virtuser_sysfs_emit_value_array(char *buf, > > + unsigned long *values, > > + size_t num_values) > > +{ > > + ssize_t len = 0; > > + size_t i; > > + > > + for (i = 0; i < num_values; i++) > > + len += sysfs_emit_at(buf, len, "%d", > > + test_bit(i, values) ? 1 : 0); > > + return len + sysfs_emit_at(buf, len, "\n"); > > Why not use %pb? > Because it outputs hex? I want to output binary, can I do it? > > +} > > ... > > > +static int gpio_virtuser_sysfs_parse_value_array(const char *buf, size_t len, > > + unsigned long *values) > > +{ > > + size_t i; > > + > > + for (i = 0; i < len; i++) { > > Perhaps > > bool val; > int ret; > > ret = kstrtobool(...); kstrtobool() accepts values we don't want here like [Tt]rue and [Ff]alse. > if (ret) > return ret; > > assign_bit(...); // btw, why atomic? > > > + if (buf[i] == '0') > > + clear_bit(i, values); > > + else if (buf[i] == '1') > > + set_bit(i, values); > > + else > > + return -EINVAL; > > > + } > > BUT, why not bitmap_parse()? > Because it parses hex, not binary. > > + return 0; > > +} > > ... > > > + unsigned long *values __free(bitmap) = bitmap_alloc(descs->ndescs, > > + GFP_KERNEL); > > Perhaps > > unsigned long *values __free(bitmap) = > bitmap_alloc(descs->ndescs, GFP_KERNEL); > > ... > > > + unsigned long *values __free(bitmap) = bitmap_zalloc(descs->ndescs, > > + GFP_KERNEL); > > In the similar way? > > ... > > > + unsigned long *values __free(bitmap) = bitmap_zalloc(descs->ndescs, > > + GFP_KERNEL); > > Ditto. > > ... > > > +{ > > + return sysfs_emit(buf, "%s\n", > > + dir == GPIO_LINE_DIRECTION_IN ? "input" : "output"); > > I think this maybe transformed to something like str_input_output() in > string_choices.h (and you don't even need to include that as it's implied by > string_helpers.h) > These helpers take bool as argument. Hard to tell whether input or output should correspond to true. I'd leave it as is. > > +} > > ... > > > +static int gpio_virtuser_parse_direction(const char *buf, int *dir, int *val) > > +{ > > + if (sysfs_streq(buf, "input")) { > > + *dir = GPIO_LINE_DIRECTION_IN; > > + return 0; > > + } > > + > > + if (sysfs_streq(buf, "output-high")) > > + *val = 1; > > + else if (sysfs_streq(buf, "output-low")) > > + *val = 0; > > + else > > + return -EINVAL; > > + > > + *dir = GPIO_LINE_DIRECTION_OUT; > > This can be transformed to use sysfs_match_string() with > > static const char * const dirs[] = { "output-low", "output-high", "input" }; > > int ret; > > ret = sysfs_match_string(...); > if (ret < 0) > return ret; > > *val = ret; > *dir = ret == 2 ? GPIO_LINE_DIRECTION_IN : GPIO_LINE_DIRECTION_OUT; > > And with this approach it even not clear why do you need dir and val to be > separated here (esp. if we add a enum like > We do want them to be separated not for better UX but to be able to test all kernel APIs (gpiod_direction_input|output() and gpiod_set_value()). > GPIO_VIRTUSER_OUT_LOW, > GPIO_VIRTUSER_OUT_HIGH, > GPIO_VIRTUSER_IN, > > (with it the string array can also be indexed). > > > + return 0; > > +} > > ... > > > +static int gpio_virtuser_parse_value(const char *buf) > > +{ > > + int value, ret; > > + > > + value = sysfs_match_string(gpio_virtuser_sysfs_value_strings, buf); > > + if (value < 0) { > > + /* Can be 0 or 1 too. */ > > + ret = kstrtoint(buf, 0, &value); > > + if (ret) > > + return ret; > > > + if (value != 0 && value != 1) > > + return -EINVAL; > > Why not kstrtobool()? > I don't want to accept all the other strings kstrtobool() is fine with. > > + } > > + > > + return value; > > +} > > ... > > > + ret = kstrtouint(buf, 10, &debounce); > > Why restrict to decimal? > Not sure what you gain from passing a period in hex? > > + if (ret) > > + return ret; > > ... > > > +static ssize_t > > +gpio_virtuser_sysfs_consumer_store(struct device *dev, > > + struct device_attribute *attr, > > + const char *buf, size_t len) > > +{ > > + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); > > + int ret; > > > + if (strlen(buf) > GPIO_CONSUMER_NAME_MAX_LEN) > > + return -EINVAL; > > You don't need this if you use strscpy() below and check its returned value. > Ok. > > + guard(mutex)(&data->consumer_lock); > > + > > + ret = gpiod_set_consumer_name(data->desc, buf); > > + if (ret) > > + return ret; > > + > > + sprintf(data->consumer, buf); > > + > > + return len; > > +} > > ... > > > + data->attr_group->name = devm_kasprintf(dev, GFP_KERNEL, > > + "gpiod:%s", id); > > Why two lines? > It's not even longer than previously with the new struct layout so it warrants a break. > > + if (!data->attr_group->name) > > + return -ENOMEM; > > ... > > > + ret = devm_add_action_or_reset(dev, gpio_virtuser_mutex_destroy, > > + &data->consumer_lock); > > Don't we have devm_mutex_init() (`git tag --contains` shows v6.10-rc1 to me) > Ah we do now. This code dates back from early 2023 I think. I'll use it. > > + return ret; > > ... > > > +static int gpio_virtuser_prop_is_gpio(struct property *prop) > > +{ > > + char *dash = strpbrk(prop->name, "-"); > > Why not strrchr() ? > Ok. > > + return dash && strcmp(dash, "-gpios") == 0; > > Can't we reuse the suffix from the array from the gpiolib internal header? > Also I don't like the form of '-' in the line. "gpios" is good and chance > that linker deduplicates the same string if it occurs somewhere else in the > binary (in case this goes with =y in .config). > I'm not sure I follow what you're saying here. Please rephrase. > > +} > > ... > > > +/* > > + * If this is an OF-based system, then we iterate over properties and consider > > + * all whose names end in "-gpios". For configfs we expect an additional string > > + * array property - "gpio-virtuser,ids" - containing the list of all GPIO IDs > > + * to request. > > Why not any other system? What's wrong for having this available for ACPI, for > example? Okay, I see that this is probably due to absence of API. > > OTOH the last call in the function assumes non-OF cases. Why can't we have the > same approach in both? > Again: I have no idea what you mean. We support device-tree and configfs as sources of configuration for these virtual consumers. If you want to add something more, be my guest once it's upstream. The reason to use a different approach is to not require the "gpio-virtuser,ids" property in device-tree. > > + */ > > +static int gpio_virtuser_count_ids(struct device *dev) > > +{ > > + struct fwnode_handle *fwnode = dev_fwnode(dev); > > Why? This function is mostly OF one, make it simpler. > > struct device_node *np = dev_of_node(dev); > > > + struct property *prop; > > + int ret = 0; > > > + if (is_of_node(fwnode)) { > > Instead of this check... > > if (np) { > > ...can be used. > Ok. > > > + for_each_property_of_node(to_of_node(fwnode), prop) { > > for_each_property_of_node(np, prop) { > > > + if (gpio_virtuser_prop_is_gpio(prop)) > > + ++ret; > > Why pre-increment? Why not? > > > + } > > > + return ret; > > + } > > > + return device_property_string_array_count(dev, "gpio-virtuser,ids"); > > +} > > ... > > > +static int gpio_virtuser_get_ids(struct device *dev, const char **ids, > > + int num_ids) > > +{ > > + struct fwnode_handle *fwnode = dev_fwnode(dev); > > + struct property *prop; > > + size_t pos = 0, diff; > > + char *dash, *tmp; > > + > > + if (is_of_node(fwnode)) { > > + for_each_property_of_node(to_of_node(fwnode), prop) { > > As per above function. > Ok > > + if (!gpio_virtuser_prop_is_gpio(prop)) > > + continue; > > + > > + dash = strpbrk(prop->name, "-"); > > + diff = dash - prop->name; > > + > > + tmp = devm_kmemdup(dev, prop->name, diff + 1, > > + GFP_KERNEL); > > devm_kstrndup() is not okay? Okay, we don't have it (yet?), but at least I > would rather expect wrapped kstrndup() than this. > Meh, this logic is fine as we know the range exactly. IMO kstrndup() here would be overkill. I'd leave it for now. > > + if (!tmp) > > + return -ENOMEM; > > + > > + tmp[diff] = '\0'; > > + ids[pos++] = tmp; > > + } > > + > > + return 0; > > + } > > + > > + return device_property_read_string_array(dev, "gpio-virtuser,ids", > > + ids, num_ids); > > +} > > ... > > > +static int gpio_virtuser_probe(struct platform_device *pdev) > > +{ > > + struct device *dev = &pdev->dev; > > + struct gpio_descs *descs; > > + int ret, num_ids = 0, i; > > + const char **ids; > > + unsigned int j; > > + > > + num_ids = gpio_virtuser_count_ids(dev); > > + if (num_ids < 0) > > + return dev_err_probe(dev, num_ids, > > + "Failed to get the number of GPIOs to request\n"); > > + > > + if (num_ids == 0) { > > + dev_err(dev, "No GPIO IDs specified\n"); > > + return -EINVAL; > > It's okay to > > return dev_err_probe(...); > > with know error code. > Ok. > > + } > > + > > + ids = devm_kcalloc(dev, num_ids, sizeof(*ids), GFP_KERNEL); > > + if (!ids) > > + return -ENOMEM; > > + > > + ret = gpio_virtuser_get_ids(dev, ids, num_ids); > > + if (ret < 0) > > + return dev_err_probe(dev, ret, > > + "Failed to get the IDs of GPIOs to request\n"); > > + > > + for (i = 0; i < num_ids; i++) { > > + descs = devm_gpiod_get_array(dev, ids[i], GPIOD_ASIS); > > + if (IS_ERR(descs)) > > + return dev_err_probe(dev, PTR_ERR(descs), > > + "Failed to request the '%s' GPIOs\n", > > + ids[i]); > > + > > + ret = gpio_virtuser_sysfs_init_line_array_attrs(dev, descs, > > + ids[i]); > > + if (ret) > > + return dev_err_probe(dev, ret, > > + "Failed to setup the sysfs array interface for the '%s' GPIOs\n", > > + ids[i]); > > + > > + for (j = 0; j < descs->ndescs; j++) { > > + ret = gpio_virtuser_sysfs_init_line_attrs(dev, > > + descs->desc[j], > > + ids[i], j); > > + if (ret) > > + return dev_err_probe(dev, ret, > > + "Failed to setup the sysfs line interface for the '%s' GPIOs\n", > > + ids[i]); > > + } > > + } > > + > > + return 0; > > +} > > ... > > > +static int gpio_virtuser_bus_notifier_call(struct notifier_block *nb, > > + unsigned long action, void *data) > > +{ > > + struct gpio_virtuser_device *vdev; > > + struct device *dev = data; > > + char devname[32]; > > + > > + vdev = container_of(nb, struct gpio_virtuser_device, bus_notifier); > > + snprintf(devname, sizeof(devname), "gpio-virtuser.%d", vdev->id); > > + > > + if (strcmp(dev_name(dev), devname)) > > if (!device_match_name(...)) > Ok > > + return NOTIFY_DONE; > > + > > + switch (action) { > > + case BUS_NOTIFY_BOUND_DRIVER: > > + vdev->driver_bound = true; > > + break; > > + case BUS_NOTIFY_DRIVER_NOT_BOUND: > > + vdev->driver_bound = false; > > + break; > > + default: > > + return NOTIFY_DONE; > > + } > > + > > + complete(&vdev->probe_completion); > > + return NOTIFY_OK; > > +} > > ... > > > +static ssize_t > > +gpio_virtuser_lookup_entry_config_key_store(struct config_item *item, > > + const char *page, size_t count) > > +{ > > + struct gpio_virtuser_lookup_entry *entry = > > + to_gpio_virtuser_lookup_entry(item); > > + struct gpio_virtuser_device *dev = entry->parent->parent; > > + > > + char *key = kstrndup(skip_spaces(page), count, GFP_KERNEL); > > Missing __free() ? > Right. > > + if (!key) > > + return -ENOMEM; > > > + strim(key); > > > + guard(mutex)(&dev->lock); > > + > > + if (gpio_virtuser_device_is_live(dev)) > > + return -EBUSY; > > + > > + kfree(entry->key); > > + entry->key = no_free_ptr(key); > > + > > + return count; > > +} > > ... > > > + if (sysfs_streq(page, "pull-up")) { > > + entry->flags &= ~(GPIO_PULL_DOWN | GPIO_PULL_DISABLE); > > + entry->flags |= GPIO_PULL_UP; > > + } else if (sysfs_streq(page, "pull-down")) { > > + entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DISABLE); > > + entry->flags |= GPIO_PULL_DOWN; > > + } else if (sysfs_streq(page, "pull-disabled")) { > > + entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DOWN); > > + entry->flags |= GPIO_PULL_DISABLE; > > + } else if (sysfs_streq(page, "as-is")) { > > + entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DOWN | > > + GPIO_PULL_DISABLE); > > + } else { > > + count = -EINVAL; > > return -EINVAL won't (ab)use count semantics. > > + } > > + > > + return count; > > ... > > > + return sprintf(page, "%s\n", flags & GPIO_ACTIVE_LOW ? "1" : "0"); > > Somewhere above you used %d for very similar situation, why %s here? > Or why "5d" there? > No reason, I'll unify it. > ... > > > + return sprintf(page, "%s\n", flags & GPIO_TRANSITORY ? "1" : "0"); > > Ditto. > > ... > > > + return sprintf(page, "%c\n", live ? '1' : '0'); > > Wow! Third type of the same. > > ... > > > + struct gpiod_lookup_table *table __free(kfree) = > > + kzalloc(struct_size(table, table, num_entries + 1), GFP_KERNEL); > > + if (!table) > > + return -ENOMEM; > > > + table->dev_id = kasprintf(GFP_KERNEL, "gpio-virtuser.%d", > > + dev->id); > > Perfectly one line in comparison with the few lines above). > Ok > > + if (!table->dev_id) > > + return -ENOMEM; > > ... > > > + curr->chip_hwnum = entry->offset < 0 > > + ? U16_MAX : entry->offset; > > Can we leave ? on the previous line? > > ... > > > + ++i; > > Why pre-increment? > > ... > > > +static struct fwnode_handle * > > +gpio_virtuser_make_device_swnode(struct gpio_virtuser_device *dev) > > +{ > > + struct property_entry properties[2]; > > + struct gpio_virtuser_lookup *lookup; > > + size_t num_ids; > > + int i = 0; > > Why signed? And in all this kind of case, I would split assignment... > > > + memset(properties, 0, sizeof(properties)); > > + > > + num_ids = list_count_nodes(&dev->lookup_list); > > + char **ids __free(kfree) = kcalloc(num_ids + 1, sizeof(*ids), > > + GFP_KERNEL); > > + if (!ids) > > + return ERR_PTR(-ENOMEM); > > + > > To be here, that the reader will see immediately (close enough) what is the > initial values. Moreover this code will be robuse against changes in between > (if i become reusable). > Sorry, I can't parse it. > > + list_for_each_entry(lookup, &dev->lookup_list, siblings) > > + ids[i++] = lookup->con_id; > > + > > + properties[0] = PROPERTY_ENTRY_STRING_ARRAY_LEN("gpio-virtuser,ids", > > + ids, num_ids); > > + > > + return fwnode_create_software_node(properties, NULL); > > +} > > ... > > > + guard(mutex)(&dev->lock); > > + > > + if (live == gpio_virtuser_device_is_live(dev)) > > + ret = -EPERM; > > With guard in place, just return directly, ... > > > + else if (live) > > ...drop 'else'... > > > + ret = gpio_virtuser_device_activate(dev); > > + else > > ...ditto... > > > + gpio_virtuser_device_deactivate(dev); > > + > > + return ret ?: count; > > ...and simply return count here. > Ok. > > ... > > > + struct gpio_virtuser_device *dev __free(kfree) = kzalloc(sizeof(*dev), > > + GFP_KERNEL); > > struct gpio_virtuser_device *dev __free(kfree) = > kzalloc(sizeof(*dev), GFP_KERNEL); > > > + if (!dev) > > + return ERR_PTR(-ENOMEM); > > ... > > > + ret = platform_driver_register(&gpio_virtuser_driver); > > + if (ret) { > > > + pr_err("Failed to register the platform driver: %d\n", > > + ret); > > I would keep one line. > Ok. > > + return ret; > > + } > > -- > With Best Regards, > Andy Shevchenko > > Thanks for the review! Bart
Mon, Jun 10, 2024 at 03:22:32PM +0200, Bartosz Golaszewski kirjoitti: > On Wed, May 29, 2024 at 11:00 PM Andy Shevchenko > <andy.shevchenko@gmail.com> wrote: > > Mon, May 27, 2024 at 04:40:54PM +0200, Bartosz Golaszewski kirjoitti: ... > > > User must pass exactly the number of values that the array contains > > > > Can't we assume non-active values for the rest if less than needed were > > provided? For more than that, why do we care? > > Honestly, what good would it do? It would just be more confusing IMO. Let's say you can leave documentation as is, but relax the code. That's the benefit, less complex checks in the code. ... > > > +#include <linux/atomic.h> > > > +#include <linux/bitmap.h> > > > +#include <linux/cleanup.h> > > > +#include <linux/completion.h> > > > +#include <linux/configfs.h> > > > +#include <linux/device.h> > > > +#include <linux/err.h> > > > +#include <linux/gpio/consumer.h> > > > +#include <linux/gpio/driver.h> > > > +#include <linux/gpio/machine.h> > > > > > +#include <linux/idr.h> > > > > > +#include <linux/interrupt.h> > > > +#include <linux/irq_work.h> > > > > > +#include <linux/kernel.h> > > > > Do you need this? > > ARRAY_SIZE() used to live here when I first wrote this but it was > since moved. I'll drop this. Rather replace with array_size.h. > > > +#include <linux/limits.h> > > > +#include <linux/list.h> > > > +#include <linux/lockdep.h> > > > +#include <linux/mod_devicetable.h> > > > +#include <linux/module.h> > > > +#include <linux/mutex.h> > > > +#include <linux/notifier.h> > > > +#include <linux/of.h> > > > +#include <linux/overflow.h> > > > +#include <linux/platform_device.h> > > > +#include <linux/printk.h> > > > +#include <linux/property.h> > > > +#include <linux/slab.h> > > > > > +#include <linux/string.h> > > > > Implied by string_helpers.h > > Yeah, but we still use symbols directly from string.h, we shouldn't > depend on implicit includes. string_helpers.h is and will continue guranteening inclusion of string.h. It's the same as we drop bits.h when we include, for instance, bitmap.h. > > > +#include <linux/string_helpers.h> > > > +#include <linux/sysfs.h> > > > +#include <linux/types.h> ... > > > +struct gpio_virtuser_attr_descr { > > > + const char *name; > > > + ssize_t (*show)(struct device *, struct device_attribute *, char *); > > > + ssize_t (*store)(struct device *, struct device_attribute *, > > > + const char *, size_t); > > > +}; > > > > struct device_attribute ? (Yes, I know that that one is a bit bigger but > > benefit is that we have some code that you may reuse) > > Not sure what you mean here, these are callbacks for sysfs. I mean to replace your custom data type with the existing device_attribute. ... > > > +static ssize_t gpio_virtuser_sysfs_emit_value_array(char *buf, > > > + unsigned long *values, > > > + size_t num_values) > > > +{ > > > + ssize_t len = 0; > > > + size_t i; > > > + > > > + for (i = 0; i < num_values; i++) > > > + len += sysfs_emit_at(buf, len, "%d", > > > + test_bit(i, values) ? 1 : 0); > > > + return len + sysfs_emit_at(buf, len, "\n"); > > > > Why not use %pb? > > Because it outputs hex? I want to output binary, can I do it? But why do you need that? You can also print a list of numbers of bits that set (%pbl). We have a few ABIs in the kernel that works nice and people are familiar with (CPU sets, IRQ affinity masks, etc). Why to reinvent the wheel? > > > +} ... > > > +static int gpio_virtuser_sysfs_parse_value_array(const char *buf, size_t len, > > > + unsigned long *values) > > > +{ > > > + size_t i; > > > + > > > + for (i = 0; i < len; i++) { > > > > Perhaps > > > > bool val; > > int ret; > > > > ret = kstrtobool(...); > > kstrtobool() accepts values we don't want here like [Tt]rue and [Ff]alse. Yes, see below. > > if (ret) > > return ret; > > > > assign_bit(...); // btw, why atomic? > > > > > + if (buf[i] == '0') > > > + clear_bit(i, values); > > > + else if (buf[i] == '1') > > > + set_bit(i, values); > > > + else > > > + return -EINVAL; > > > > > + } > > > > BUT, why not bitmap_parse()? > > Because it parses hex, not binary. So, why do we reinvent a wheel? Wouldn't be better that users may apply the knowledge they familiar with (and I believe the group of the users who know about bitmaps is much bigger than those who will use this driver). > > > + return 0; > > > +} ... > > > + return sysfs_emit(buf, "%s\n", > > > + dir == GPIO_LINE_DIRECTION_IN ? "input" : "output"); > > > > I think this maybe transformed to something like str_input_output() in > > string_choices.h (and you don't even need to include that as it's implied by > > string_helpers.h) > > These helpers take bool as argument. Hard to tell whether input or > output should correspond to true. I'd leave it as is. There is a convention: str_TRUE_FALSE(). ... > > > +static int gpio_virtuser_parse_direction(const char *buf, int *dir, int *val) > > > +{ > > > + if (sysfs_streq(buf, "input")) { > > > + *dir = GPIO_LINE_DIRECTION_IN; > > > + return 0; > > > + } > > > + > > > + if (sysfs_streq(buf, "output-high")) > > > + *val = 1; > > > + else if (sysfs_streq(buf, "output-low")) > > > + *val = 0; > > > + else > > > + return -EINVAL; > > > + > > > + *dir = GPIO_LINE_DIRECTION_OUT; > > > > This can be transformed to use sysfs_match_string() with > > > > static const char * const dirs[] = { "output-low", "output-high", "input" }; > > > > int ret; > > > > ret = sysfs_match_string(...); > > if (ret < 0) > > return ret; > > > > *val = ret; > > *dir = ret == 2 ? GPIO_LINE_DIRECTION_IN : GPIO_LINE_DIRECTION_OUT; > > > > And with this approach it even not clear why do you need dir and val to be > > separated here (esp. if we add a enum like > > We do want them to be separated not for better UX but to be able to > test all kernel APIs (gpiod_direction_input|output() and > gpiod_set_value()). Still you can do some optimisations I proposed above. > > GPIO_VIRTUSER_OUT_LOW, > > GPIO_VIRTUSER_OUT_HIGH, > > GPIO_VIRTUSER_IN, > > > > (with it the string array can also be indexed). > > > > > + return 0; > > > +} ... > > > +static int gpio_virtuser_parse_value(const char *buf) > > > +{ > > > + int value, ret; > > > + > > > + value = sysfs_match_string(gpio_virtuser_sysfs_value_strings, buf); > > > + if (value < 0) { > > > + /* Can be 0 or 1 too. */ > > > + ret = kstrtoint(buf, 0, &value); > > > + if (ret) > > > + return ret; > > > > > + if (value != 0 && value != 1) > > > + return -EINVAL; > > > > Why not kstrtobool()? > > I don't want to accept all the other strings kstrtobool() is fine with. What's wrong with other strings? At bare minumum you can reduce the range by using kstrtou8(). > > > + } > > > + > > > + return value; > > > +} ... > > > + ret = kstrtouint(buf, 10, &debounce); > > > > Why restrict to decimal? > > Not sure what you gain from passing a period in hex? For example, if I compare this to the real HW, I might be able to do something like 0x1234 (let's say it's debounce step) and shifting it by 4 bits will give me something I want. But despite that quite unlikely case the restriction here doesn't bring us much. > > > + if (ret) > > > + return ret; ... > > > + return dash && strcmp(dash, "-gpios") == 0; > > > > Can't we reuse the suffix from the array from the gpiolib internal header? > > Also I don't like the form of '-' in the line. "gpios" is good and chance > > that linker deduplicates the same string if it occurs somewhere else in the > > binary (in case this goes with =y in .config). > > I'm not sure I follow what you're saying here. Please rephrase. Do strcmp() against one from the gpio_suffixes array. ... > > > +/* > > > + * If this is an OF-based system, then we iterate over properties and consider > > > + * all whose names end in "-gpios". For configfs we expect an additional string > > > + * array property - "gpio-virtuser,ids" - containing the list of all GPIO IDs > > > + * to request. > > > > Why not any other system? What's wrong for having this available for ACPI, for > > example? Okay, I see that this is probably due to absence of API. > > > > OTOH the last call in the function assumes non-OF cases. Why can't we have the > > same approach in both? > > Again: I have no idea what you mean. We support device-tree and > configfs as sources of configuration for these virtual consumers. If > you want to add something more, be my guest once it's upstream. > > The reason to use a different approach is to not require the > "gpio-virtuser,ids" property in device-tree. Yes, and I'm asking why can't we unify and require it there as well? But okay, I might give up on the trying of the DT/ACPI property unification. > > > + */ ... > > > + if (gpio_virtuser_prop_is_gpio(prop)) > > > + ++ret; > > > > Why pre-increment? > > Why not? Because we have a pattern. Pre-increment adds into additional questioning "why?". I.e. What does make this case special? When I read such a code I need more brain power to parse it. ... > > > + dash = strpbrk(prop->name, "-"); Btw, don't you want strrchr() here? (Note 'r' variant). > > > + diff = dash - prop->name; > > > + > > > + tmp = devm_kmemdup(dev, prop->name, diff + 1, > > > + GFP_KERNEL); > > > > devm_kstrndup() is not okay? Okay, we don't have it (yet?), but at least I > > would rather expect wrapped kstrndup() than this. > > Meh, this logic is fine as we know the range exactly. IMO kstrndup() > here would be overkill. I'd leave it for now. > > > > + if (!tmp) > > > + return -ENOMEM; > > > + tmp[diff] = '\0'; This line will gone with kstrndup(). I think we will benefit from it. ... > > > + int i = 0; > > > > Why signed? And in all this kind of case, I would split assignment... (1) > > > + memset(properties, 0, sizeof(properties)); > > > + > > > + num_ids = list_count_nodes(&dev->lookup_list); > > > + char **ids __free(kfree) = kcalloc(num_ids + 1, sizeof(*ids), > > > + GFP_KERNEL); > > > + if (!ids) > > > + return ERR_PTR(-ENOMEM); > > > + > > > > To be here, that the reader will see immediately (close enough) what is the > > initial values. Moreover this code will be robuse against changes in between > > (if i become reusable). > > Sorry, I can't parse it. I meant to see here i = 0; instead of the above (1). > > > + list_for_each_entry(lookup, &dev->lookup_list, siblings) > > > + ids[i++] = lookup->con_id;
On Mon, Jun 10, 2024 at 4:57 PM Andy Shevchenko <andy.shevchenko@gmail.com> wrote: > > Mon, Jun 10, 2024 at 03:22:32PM +0200, Bartosz Golaszewski kirjoitti: > > On Wed, May 29, 2024 at 11:00 PM Andy Shevchenko > > <andy.shevchenko@gmail.com> wrote: > > > Mon, May 27, 2024 at 04:40:54PM +0200, Bartosz Golaszewski kirjoitti: > > ... > > > > > User must pass exactly the number of values that the array contains > > > > > > Can't we assume non-active values for the rest if less than needed were > > > provided? For more than that, why do we care? > > > > Honestly, what good would it do? It would just be more confusing IMO. > > Let's say you can leave documentation as is, but relax the code. That's the > benefit, less complex checks in the code. > Actually this is more ambiguity in the code. I'm against it. > ... > > > > > +#include <linux/atomic.h> > > > > +#include <linux/bitmap.h> > > > > +#include <linux/cleanup.h> > > > > +#include <linux/completion.h> > > > > +#include <linux/configfs.h> > > > > +#include <linux/device.h> > > > > +#include <linux/err.h> > > > > +#include <linux/gpio/consumer.h> > > > > +#include <linux/gpio/driver.h> > > > > +#include <linux/gpio/machine.h> > > > > > > > +#include <linux/idr.h> > > > > > > > +#include <linux/interrupt.h> > > > > +#include <linux/irq_work.h> > > > > > > > +#include <linux/kernel.h> > > > > > > Do you need this? > > > > ARRAY_SIZE() used to live here when I first wrote this but it was > > since moved. I'll drop this. > > Rather replace with array_size.h. > Yeah this is what I did. > > > > +#include <linux/limits.h> > > > > +#include <linux/list.h> > > > > +#include <linux/lockdep.h> > > > > +#include <linux/mod_devicetable.h> > > > > +#include <linux/module.h> > > > > +#include <linux/mutex.h> > > > > +#include <linux/notifier.h> > > > > +#include <linux/of.h> > > > > +#include <linux/overflow.h> > > > > +#include <linux/platform_device.h> > > > > +#include <linux/printk.h> > > > > +#include <linux/property.h> > > > > +#include <linux/slab.h> > > > > > > > +#include <linux/string.h> > > > > > > Implied by string_helpers.h > > > > Yeah, but we still use symbols directly from string.h, we shouldn't > > depend on implicit includes. > > string_helpers.h is and will continue guranteening inclusion of string.h. > It's the same as we drop bits.h when we include, for instance, bitmap.h. > Whatever, ok. > > > > +#include <linux/string_helpers.h> > > > > +#include <linux/sysfs.h> > > > > +#include <linux/types.h> > > ... > > > > > +struct gpio_virtuser_attr_descr { > > > > + const char *name; > > > > + ssize_t (*show)(struct device *, struct device_attribute *, char *); > > > > + ssize_t (*store)(struct device *, struct device_attribute *, > > > > + const char *, size_t); > > > > +}; > > > > > > struct device_attribute ? (Yes, I know that that one is a bit bigger but > > > benefit is that we have some code that you may reuse) > > > > Not sure what you mean here, these are callbacks for sysfs. > > I mean to replace your custom data type with the existing device_attribute. > Doesn't make sense here. struct device_attribute has lots of cruft we don't need here. It's just the name and the callback pointers. > ... > > > > > +static ssize_t gpio_virtuser_sysfs_emit_value_array(char *buf, > > > > + unsigned long *values, > > > > + size_t num_values) > > > > +{ > > > > + ssize_t len = 0; > > > > + size_t i; > > > > + > > > > + for (i = 0; i < num_values; i++) > > > > + len += sysfs_emit_at(buf, len, "%d", > > > > + test_bit(i, values) ? 1 : 0); > > > > + return len + sysfs_emit_at(buf, len, "\n"); > > > > > > Why not use %pb? > > > > Because it outputs hex? I want to output binary, can I do it? > > But why do you need that? You can also print a list of numbers of bits that > set (%pbl). > > We have a few ABIs in the kernel that works nice and people are familiar with > (CPU sets, IRQ affinity masks, etc). Why to reinvent the wheel? If I see "11001011" as output, I can immediately convert that to pins in my head. If I see 0xcb, I need to use a calculator. > > > > > +} > > ... > > > > > +static int gpio_virtuser_sysfs_parse_value_array(const char *buf, size_t len, > > > > + unsigned long *values) > > > > +{ > > > > + size_t i; > > > > + > > > > + for (i = 0; i < len; i++) { > > > > > > Perhaps > > > > > > bool val; > > > int ret; > > > > > > ret = kstrtobool(...); > > > > kstrtobool() accepts values we don't want here like [Tt]rue and [Ff]alse. > > Yes, see below. > > > > if (ret) > > > return ret; > > > > > > assign_bit(...); // btw, why atomic? > > > > > > > + if (buf[i] == '0') > > > > + clear_bit(i, values); > > > > + else if (buf[i] == '1') > > > > + set_bit(i, values); > > > > + else > > > > + return -EINVAL; > > > > > > > + } > > > > > > BUT, why not bitmap_parse()? > > > > Because it parses hex, not binary. > > So, why do we reinvent a wheel? Wouldn't be better that users may apply the > knowledge they familiar with (and I believe the group of the users who know > about bitmaps is much bigger than those who will use this driver). > > > > > + return 0; > > > > +} > > ... > > > > > + return sysfs_emit(buf, "%s\n", > > > > + dir == GPIO_LINE_DIRECTION_IN ? "input" : "output"); > > > > > > I think this maybe transformed to something like str_input_output() in > > > string_choices.h (and you don't even need to include that as it's implied by > > > string_helpers.h) > > > > These helpers take bool as argument. Hard to tell whether input or > > output should correspond to true. I'd leave it as is. > > There is a convention: str_TRUE_FALSE(). > > ... > > > > > +static int gpio_virtuser_parse_direction(const char *buf, int *dir, int *val) > > > > +{ > > > > + if (sysfs_streq(buf, "input")) { > > > > + *dir = GPIO_LINE_DIRECTION_IN; > > > > + return 0; > > > > + } > > > > + > > > > + if (sysfs_streq(buf, "output-high")) > > > > + *val = 1; > > > > + else if (sysfs_streq(buf, "output-low")) > > > > + *val = 0; > > > > + else > > > > + return -EINVAL; > > > > + > > > > + *dir = GPIO_LINE_DIRECTION_OUT; > > > > > > This can be transformed to use sysfs_match_string() with > > > > > > static const char * const dirs[] = { "output-low", "output-high", "input" }; > > > > > > int ret; > > > > > > ret = sysfs_match_string(...); > > > if (ret < 0) > > > return ret; > > > > > > *val = ret; > > > *dir = ret == 2 ? GPIO_LINE_DIRECTION_IN : GPIO_LINE_DIRECTION_OUT; > > > > > > And with this approach it even not clear why do you need dir and val to be > > > separated here (esp. if we add a enum like > > > > We do want them to be separated not for better UX but to be able to > > test all kernel APIs (gpiod_direction_input|output() and > > gpiod_set_value()). > > Still you can do some optimisations I proposed above. > IMO they are much less readable and you don't gain anything. NAK on this one. > > > GPIO_VIRTUSER_OUT_LOW, > > > GPIO_VIRTUSER_OUT_HIGH, > > > GPIO_VIRTUSER_IN, > > > > > > (with it the string array can also be indexed). > > > > > > > + return 0; > > > > +} > > ... > > > > > +static int gpio_virtuser_parse_value(const char *buf) > > > > +{ > > > > + int value, ret; > > > > + > > > > + value = sysfs_match_string(gpio_virtuser_sysfs_value_strings, buf); > > > > + if (value < 0) { > > > > + /* Can be 0 or 1 too. */ > > > > + ret = kstrtoint(buf, 0, &value); > > > > + if (ret) > > > > + return ret; > > > > > > > + if (value != 0 && value != 1) > > > > + return -EINVAL; > > > > > > Why not kstrtobool()? > > > > I don't want to accept all the other strings kstrtobool() is fine with. > > What's wrong with other strings? > A line is False? I mean sure, you can map that to inactive but it's not a naming convention associated with GPIOs very often. > At bare minumum you can reduce the range by using kstrtou8(). > As opposed to just checking '0' and '1'? Meh... > > > > + } > > > > + > > > > + return value; > > > > +} > > ... > > > > > + ret = kstrtouint(buf, 10, &debounce); > > > > > > Why restrict to decimal? > > > > Not sure what you gain from passing a period in hex? > > For example, if I compare this to the real HW, I might be able to do something > like 0x1234 (let's say it's debounce step) and shifting it by 4 bits will give > me something I want. But despite that quite unlikely case the restriction here > doesn't bring us much. > Ok, whatever. > > > > + if (ret) > > > > + return ret; > > ... > > > > > + return dash && strcmp(dash, "-gpios") == 0; > > > > > > Can't we reuse the suffix from the array from the gpiolib internal header? > > > Also I don't like the form of '-' in the line. "gpios" is good and chance > > > that linker deduplicates the same string if it occurs somewhere else in the > > > binary (in case this goes with =y in .config). > > > > I'm not sure I follow what you're saying here. Please rephrase. > > Do strcmp() against one from the gpio_suffixes array. > I don't want to accept the "gpio" suffix. Also: I don't want to include gpiolib.h. > ... > > > > > +/* > > > > + * If this is an OF-based system, then we iterate over properties and consider > > > > + * all whose names end in "-gpios". For configfs we expect an additional string > > > > + * array property - "gpio-virtuser,ids" - containing the list of all GPIO IDs > > > > + * to request. > > > > > > Why not any other system? What's wrong for having this available for ACPI, for > > > example? Okay, I see that this is probably due to absence of API. > > > > > > OTOH the last call in the function assumes non-OF cases. Why can't we have the > > > same approach in both? > > > > Again: I have no idea what you mean. We support device-tree and > > configfs as sources of configuration for these virtual consumers. If > > you want to add something more, be my guest once it's upstream. > > > > The reason to use a different approach is to not require the > > "gpio-virtuser,ids" property in device-tree. > > Yes, and I'm asking why can't we unify and require it there as well? > But okay, I might give up on the trying of the DT/ACPI property unification. > > > > > + */ > > ... > > > > > + if (gpio_virtuser_prop_is_gpio(prop)) > > > > + ++ret; > > > > > > Why pre-increment? > > > > Why not? > > Because we have a pattern. Pre-increment adds into additional questioning > "why?". I.e. What does make this case special? When I read such a code I need > more brain power to parse it. > Ok whatever. > ... > > > > > + dash = strpbrk(prop->name, "-"); > > Btw, don't you want strrchr() here? (Note 'r' variant). Already changed. > > > > > + diff = dash - prop->name; > > > > + > > > > + tmp = devm_kmemdup(dev, prop->name, diff + 1, > > > > + GFP_KERNEL); > > > > > > devm_kstrndup() is not okay? Okay, we don't have it (yet?), but at least I > > > would rather expect wrapped kstrndup() than this. > > > > Meh, this logic is fine as we know the range exactly. IMO kstrndup() > > here would be overkill. I'd leave it for now. > > > > > > + if (!tmp) > > > > + return -ENOMEM; > > > > > + tmp[diff] = '\0'; > > This line will gone with kstrndup(). I think we will benefit from it. > I'll allow myself to keep my version here. > ... > > > > > + int i = 0; > > > > > > Why signed? And in all this kind of case, I would split assignment... > > (1) > > > > > + memset(properties, 0, sizeof(properties)); > > > > + > > > > + num_ids = list_count_nodes(&dev->lookup_list); > > > > + char **ids __free(kfree) = kcalloc(num_ids + 1, sizeof(*ids), > > > > + GFP_KERNEL); > > > > + if (!ids) > > > > + return ERR_PTR(-ENOMEM); > > > > + > > > > > > To be here, that the reader will see immediately (close enough) what is the > > > initial values. Moreover this code will be robuse against changes in between > > > (if i become reusable). > > > > Sorry, I can't parse it. > > I meant to see here > > i = 0; > > instead of the above (1). > Why? I see no good reason. > > > > + list_for_each_entry(lookup, &dev->lookup_list, siblings) > > > > + ids[i++] = lookup->con_id; > > -- > With Best Regards, > Andy Shevchenko > > Bart
On Wed, Jun 12, 2024 at 8:38 PM Bartosz Golaszewski <brgl@bgdev.pl> wrote: > On Mon, Jun 10, 2024 at 4:57 PM Andy Shevchenko > <andy.shevchenko@gmail.com> wrote: > > Mon, Jun 10, 2024 at 03:22:32PM +0200, Bartosz Golaszewski kirjoitti: > > > On Wed, May 29, 2024 at 11:00 PM Andy Shevchenko > > > <andy.shevchenko@gmail.com> wrote: > > > > Mon, May 27, 2024 at 04:40:54PM +0200, Bartosz Golaszewski kirjoitti: ... > > > > > +static ssize_t gpio_virtuser_sysfs_emit_value_array(char *buf, > > > > > + unsigned long *values, > > > > > + size_t num_values) > > > > > +{ > > > > > + ssize_t len = 0; > > > > > + size_t i; > > > > > + > > > > > + for (i = 0; i < num_values; i++) > > > > > + len += sysfs_emit_at(buf, len, "%d", > > > > > + test_bit(i, values) ? 1 : 0); > > > > > + return len + sysfs_emit_at(buf, len, "\n"); > > > > > > > > Why not use %pb? > > > > > > Because it outputs hex? I want to output binary, can I do it? > > > > But why do you need that? You can also print a list of numbers of bits that > > set (%pbl). > > > > We have a few ABIs in the kernel that works nice and people are familiar with > > (CPU sets, IRQ affinity masks, etc). Why to reinvent the wheel? > > If I see "11001011" as output, I can immediately convert that to pins > in my head. If I see 0xcb, I need to use a calculator.
diff --git a/Documentation/admin-guide/gpio/gpio-virtuser.rst b/Documentation/admin-guide/gpio/gpio-virtuser.rst new file mode 100644 index 000000000000..d0d4712cf394 --- /dev/null +++ b/Documentation/admin-guide/gpio/gpio-virtuser.rst @@ -0,0 +1,176 @@ +.. SPDX-License-Identifier: GPL-2.0-only + +Virtual GPIO Consumer +===================== + +The virtual GPIO Consumer module allows users to instantiate virtual devices +that request GPIOs and then control their behavior over sysfs. Virtual consumer +devices can be instantiated from device-tree or over configfs. + +A virtual consumer uses the driver-facing GPIO APIs and allows to cover it with +automated tests driven by user-space. The GPIOs are requested using +``gpiod_get_array()`` and so we support multiple GPIOs per connector ID. + +Creating GPIO consumers +----------------------- + +The gpio-consumer module registers a configfs subsystem called +``'gpio-virtuser'``. For details of the configfs filesystem, please refer to +the configfs documentation. + +The user can create a hierarchy of configfs groups and items as well as modify +values of exposed attributes. Once the consumer is instantiated, this hierarchy +will be translated to appropriate device properties. The general structure is: + +**Group:** ``/config/gpio-virtuser`` + +This is the top directory of the gpio-consumer configfs tree. + +**Group:** ``/config/gpio-consumer/example-name`` + +**Attribute:** ``/config/gpio-consumer/example-name/live`` + +**Attribute:** ``/config/gpio-consumer/example-name/dev_name`` + +This is a directory representing a GPIO consumer device. + +The read-only ``dev_name`` attribute exposes the name of the device as it will +appear in the system on the platform bus. This is useful for locating the +associated sysfs group under ``/sys/bus/platform/devices/$dev_name``. + +The ``'live'`` attribute allows to trigger the actual creation of the device +once it's fully configured. The accepted values are: ``'1'`` to enable the +virtual device and ``'0'`` to disable and tear it down. + +Creating GPIO lookup tables +--------------------------- + +Users can create a number of configfs groups under the device group: + +**Group:** ``/config/gpio-consumer/example-name/con_id`` + +The ``'con_id'`` directory represents a single GPIO lookup and its value maps +to the ``'con_id'`` argument of the ``gpiod_get()`` function. For example: +``con_id`` == ``'reset'`` maps to the ``reset-gpios`` device property. + +Users can assign a number of GPIOs to each lookup. Each GPIO is a sub-directory +with a user-defined name under the ``'con_id'`` group. + +**Attribute:** ``/config/gpio-consumer/example-name/con_id/0/key`` + +**Attribute:** ``/config/gpio-consumer/example-name/con_id/0/offset`` + +**Attribute:** ``/config/gpio-consumer/example-name/con_id/0/drive`` + +**Attribute:** ``/config/gpio-consumer/example-name/con_id/0/pull`` + +**Attribute:** ``/config/gpio-consumer/example-name/con_id/0/active_low`` + +**Attribute:** ``/config/gpio-consumer/example-name/con_id/0/transitory`` + +This is a group describing a single GPIO in the ``con_id-gpios`` property. + +For virtual consumers created using configfs we use machine lookup tables so +this group can be considered as a mapping between the filesystem and the fields +of a single entry in ``'struct gpiod_lookup'``. + +The ``'key'`` attribute represents either the name of the chip this GPIO +belongs to or the GPIO line name. This depends on the value of the ``'offset'`` +attribute: if its value is >= 0, then ``'key'`` represents the label of the +chip to lookup while ``'offset'`` represents the offset of the line in that +chip. If ``'offset'`` is < 0, then ``'key'`` represents the name of the line. + +The remaining attributes map to the ``'flags'`` field of the GPIO lookup +struct. The first two take string values as arguments: + +**``'drive'``:** ``'push-pull'``, ``'open-drain'``, ``'open-source'`` +**``'pull'``:** ``'pull-up'``, ``'pull-down'``, ``'pull-disabled'``, ``'as-is'`` + +``'active_low'`` and ``'transitory'`` are boolean attributes. + +Activating GPIO consumers +------------------------- + +Once the confiuration is complete, the ``'live'`` attribute must be set to 1 in +order to instantiate the consumer. It can be set back to 0 to destroy the +virtual device. The module will synchronously wait for the new simulated device +to be successfully probed and if this doesn't happen, writing to ``'live'`` will +result in an error. + +Device-tree +----------- + +Virtual GPIO consumers can also be defined in device-tree. The compatible string +must be: ``"gpio-virtuser"`` with at least one property following the +standardized GPIO pattern. + +An example device-tree code defining a virtual GPIO consumer: + +.. code-block :: none + + gpio-virt-consumer { + compatible = "gpio-virtuser"; + + foo-gpios = <&gpio0 5 GPIO_ACTIVE_LOW>, <&gpio1 2 0>; + bar-gpios = <&gpio0 6 0>; + }; + +Controlling virtual GPIO consumers +---------------------------------- + +Once active, the device will export sysfs attributes for controlling GPIO +arrays as well as each requested GPIO line separately. Let's consider the +following device property: ``foo-gpios = <&gpio0 0 0>, <&gpio0 4 0>;``. + +The following sysfs attribute groups will be created: + +**Group:** ``/sys/bus/platform/device/$dev_name/gpiod:foo/`` + +This is the group that will contain the attributes for the entire GPIO array. + +**Attribute:** ``/sys/bus/platform/device/$dev_name/gpiod:foo/values`` + +**Attribute:** ``/sys/bus/platform/device/$dev_name/gpiod:foo/values_atomic`` + +Both attributes allow to read and set arrays of GPIO values. User must pass +exactly the number of values that the array contains in the form of a string +containing zeroes and ones representing inactive and active GPIO states +respectively. In this example: ``echo 11 > values``. + +The ``values_atomic`` attribute works the same as ``values`` but the kernel +will execute the GPIO driver callbacks in interrupt context. + +**Group:** ``/sys/bus/platform/device/$dev_name/gpiod:foo:$index/`` + +This is a group that represents a single GPIO with ``$index`` being its offset +in the array. + +**Attribute:** ``/sys/bus/platform/device/$dev_name/gpiod:foo:$index/consumer`` + +Allows to set and read the consumer label of the GPIO line. + +**Attribute:** ``/sys/bus/platform/device/$dev_name/gpiod:foo:$index/debounce`` + +Allows to set and read the debounce period of the GPIO line. + +**Attribute:** ``/sys/bus/platform/device/$dev_name/gpiod:foo:$index/direction`` + +**Attribute:** ``/sys/bus/platform/device/$dev_name/gpiod:foo:$index/direction_atomic`` + +These two attributes allow to set the direction of the GPIO line. They accept +"input" and "output" as values. The atomic variant executes the driver callback +in interrupt context. + +**Attribute:** ``/sys/bus/platform/device/$dev_name/gpiod:foo:$index/interrupts`` + +If the line is requested in input mode, writing ``1`` to this attribute will +make the module listen for edge interrupts on the GPIO. Writing ``0`` disables +the monitoring. Reading this attribute returns the current number of registered +interrupts (both edges). + +**Attribute:** ``/sys/bus/platform/device/$dev_name/gpiod:foo:$index/value`` + +**Attribute:** ``/sys/bus/platform/device/$dev_name/gpiod:foo:$index/value_atomic`` + +Both attributes allow to read and set values of individual requested GPIO lines. +They accept the following values: ``active``, ``1``, ``inactive`` and ``0``. diff --git a/Documentation/admin-guide/gpio/index.rst b/Documentation/admin-guide/gpio/index.rst index 460afd29617e..712f379731cb 100644 --- a/Documentation/admin-guide/gpio/index.rst +++ b/Documentation/admin-guide/gpio/index.rst @@ -10,6 +10,7 @@ GPIO Character Device Userspace API <../../userspace-api/gpio/chardev> gpio-aggregator gpio-sim + gpio-virtuser Obsolete APIs <obsolete> .. only:: subproject and html diff --git a/drivers/gpio/Kconfig b/drivers/gpio/Kconfig index 3dbddec07028..8d9f673d2955 100644 --- a/drivers/gpio/Kconfig +++ b/drivers/gpio/Kconfig @@ -1889,6 +1889,14 @@ config GPIO_SIM This enables the GPIO simulator - a configfs-based GPIO testing driver. +config GPIO_VIRTUSER + tristate "GPIO Virtual User Testing Module" + select CONFIGFS_FS + select IRQ_WORK + help + This enables the configurable, configfs-based virtual GPIO consumer + testing driver. + endmenu endif diff --git a/drivers/gpio/Makefile b/drivers/gpio/Makefile index e2a53013780e..9f2f1f687807 100644 --- a/drivers/gpio/Makefile +++ b/drivers/gpio/Makefile @@ -182,6 +182,7 @@ obj-$(CONFIG_GPIO_UNIPHIER) += gpio-uniphier.o obj-$(CONFIG_GPIO_VF610) += gpio-vf610.o obj-$(CONFIG_GPIO_VIPERBOARD) += gpio-viperboard.o obj-$(CONFIG_GPIO_VIRTIO) += gpio-virtio.o +obj-$(CONFIG_GPIO_VIRTUSER) += gpio-virtuser.o obj-$(CONFIG_GPIO_VISCONTI) += gpio-visconti.o obj-$(CONFIG_GPIO_VX855) += gpio-vx855.o obj-$(CONFIG_GPIO_WCD934X) += gpio-wcd934x.o diff --git a/drivers/gpio/gpio-virtuser.c b/drivers/gpio/gpio-virtuser.c new file mode 100644 index 000000000000..6c45fc377093 --- /dev/null +++ b/drivers/gpio/gpio-virtuser.c @@ -0,0 +1,1809 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Configurable virtual GPIO consumer module. + * + * Copyright (C) 2023-2024 Bartosz Golaszewski <bartosz.golaszewski@linaro.org> + */ + +#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt + +#include <linux/atomic.h> +#include <linux/bitmap.h> +#include <linux/cleanup.h> +#include <linux/completion.h> +#include <linux/configfs.h> +#include <linux/device.h> +#include <linux/err.h> +#include <linux/gpio/consumer.h> +#include <linux/gpio/driver.h> +#include <linux/gpio/machine.h> +#include <linux/idr.h> +#include <linux/interrupt.h> +#include <linux/irq_work.h> +#include <linux/kernel.h> +#include <linux/limits.h> +#include <linux/list.h> +#include <linux/lockdep.h> +#include <linux/mod_devicetable.h> +#include <linux/module.h> +#include <linux/mutex.h> +#include <linux/notifier.h> +#include <linux/of.h> +#include <linux/overflow.h> +#include <linux/platform_device.h> +#include <linux/printk.h> +#include <linux/property.h> +#include <linux/slab.h> +#include <linux/string.h> +#include <linux/string_helpers.h> +#include <linux/sysfs.h> +#include <linux/types.h> + +#define GPIO_CONSUMER_NAME_MAX_LEN 32 + +static DEFINE_IDA(gpio_virtuser_ida); + +enum gpio_virtuser_line_array_attr_id { + GPIO_CONSUMER_LINE_ARRAY_ATTR_VALUES, + GPIO_CONSUMER_LINE_ARRAY_ATTR_VALUES_ATOMIC, + GPIO_CONSUMER_LINE_ARRAY_ATTR_COUNT, +}; + +enum gpio_virtuser_line_attr_id { + GPIO_CONSUMER_LINE_ATTR_DIRECTION, + GPIO_CONSUMER_LINE_ATTR_DIRECTION_ATOMIC, + GPIO_CONSUMER_LINE_ATTR_VALUE, + GPIO_CONSUMER_LINE_ATTR_VALUE_ATOMIC, + GPIO_CONSUMER_LINE_ATTR_DEBOUNCE, + GPIO_CONSUMER_LINE_ATTR_CONSUMER, + GPIO_CONSUMER_LINE_ATTR_INTERRUPTS, + GPIO_CONSUMER_LINE_ATTR_COUNT, +}; + +struct gpio_virtuser_line_array_data { + struct gpio_descs *descs; + struct kobject *kobj; + struct attribute_group *attr_group; +}; + +struct gpio_virtuser_line_data { + struct gpio_desc *desc; + struct kobject *kobj; + struct attribute_group *attr_group; + char consumer[GPIO_CONSUMER_NAME_MAX_LEN]; + struct mutex consumer_lock; + unsigned int debounce; + atomic_t irq; + atomic_t irq_count; +}; + +struct gpio_virtuser_attr_ctx { + struct device_attribute dev_attr; + void *data; +}; + +static struct gpio_virtuser_attr_ctx * +to_gpio_virtuser_attr_ctx(struct device_attribute *attr) +{ + return container_of(attr, struct gpio_virtuser_attr_ctx, dev_attr); +} + +static void *to_gpio_virtuser_data(struct device_attribute *attr) +{ + struct gpio_virtuser_attr_ctx *ctx = to_gpio_virtuser_attr_ctx(attr); + + return ctx->data; +} + +struct gpio_virtuser_attr_descr { + const char *name; + ssize_t (*show)(struct device *, struct device_attribute *, char *); + ssize_t (*store)(struct device *, struct device_attribute *, + const char *, size_t); +}; + +struct gpio_virtuser_irq_work_context { + struct irq_work work; + struct completion work_completion; + + /* For single line operations: */ + struct gpio_desc *desc; + int dir; + int val; + int ret; + /* For desc array operations: */ + struct gpio_descs *descs; + unsigned long *values; +}; + +static struct gpio_virtuser_irq_work_context * +to_gpio_virtuser_irq_work_context(struct irq_work *work) +{ + return container_of(work, struct gpio_virtuser_irq_work_context, work); +} + +static void +gpio_virtuser_init_irq_work_context(struct gpio_virtuser_irq_work_context *ctx) +{ + memset(ctx, 0, sizeof(*ctx)); + init_completion(&ctx->work_completion); +} + +static void +gpio_virtuser_irq_work_queue_sync(struct gpio_virtuser_irq_work_context *ctx) +{ + irq_work_queue(&ctx->work); + wait_for_completion(&ctx->work_completion); +} + +static ssize_t gpio_virtuser_sysfs_emit_value_array(char *buf, + unsigned long *values, + size_t num_values) +{ + ssize_t len = 0; + size_t i; + + for (i = 0; i < num_values; i++) + len += sysfs_emit_at(buf, len, "%d", + test_bit(i, values) ? 1 : 0); + + return len + sysfs_emit_at(buf, len, "\n"); +} + +static int gpio_virtuser_sysfs_parse_value_array(const char *buf, size_t len, + unsigned long *values) +{ + size_t i; + + for (i = 0; i < len; i++) { + if (buf[i] == '0') + clear_bit(i, values); + else if (buf[i] == '1') + set_bit(i, values); + else + return -EINVAL; + } + + return 0; +} + +static ssize_t +gpio_virtuser_sysfs_value_array_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct gpio_virtuser_line_array_data *data = to_gpio_virtuser_data(attr); + struct gpio_descs *descs = data->descs; + int ret; + + unsigned long *values __free(bitmap) = bitmap_zalloc(descs->ndescs, + GFP_KERNEL); + if (!values) + return -ENOMEM; + + ret = gpiod_get_array_value_cansleep(descs->ndescs, descs->desc, + descs->info, values); + if (ret) + return ret; + + return gpio_virtuser_sysfs_emit_value_array(buf, values, descs->ndescs); +} + +static ssize_t +gpio_virtuser_sysfs_value_array_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t len) +{ + struct gpio_virtuser_line_array_data *data = to_gpio_virtuser_data(attr); + struct gpio_descs *descs = data->descs; + int ret; + + if (len - 1 != descs->ndescs) + return -EINVAL; + + unsigned long *values __free(bitmap) = bitmap_alloc(descs->ndescs, + GFP_KERNEL); + if (!values) + return -ENOMEM; + + ret = gpio_virtuser_sysfs_parse_value_array(buf, descs->ndescs, values); + if (ret) + return ret; + + ret = gpiod_set_array_value_cansleep(descs->ndescs, descs->desc, + descs->info, values); + if (ret) + return ret; + + return len; +} + +static void gpio_virtuser_get_value_array_atomic(struct irq_work *work) +{ + struct gpio_virtuser_irq_work_context *ctx = + to_gpio_virtuser_irq_work_context(work); + struct gpio_descs *descs = ctx->descs; + + ctx->ret = gpiod_get_array_value(descs->ndescs, descs->desc, + descs->info, ctx->values); + complete(&ctx->work_completion); +} + +static ssize_t +gpio_virtuser_sysfs_value_array_atomic_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct gpio_virtuser_line_array_data *data = to_gpio_virtuser_data(attr); + struct gpio_virtuser_irq_work_context ctx; + struct gpio_descs *descs = data->descs; + + unsigned long *values __free(bitmap) = bitmap_zalloc(descs->ndescs, + GFP_KERNEL); + if (!values) + return -ENOMEM; + + gpio_virtuser_init_irq_work_context(&ctx); + ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_get_value_array_atomic); + ctx.descs = data->descs; + ctx.values = values; + + gpio_virtuser_irq_work_queue_sync(&ctx); + + if (ctx.ret) + return ctx.ret; + + return gpio_virtuser_sysfs_emit_value_array(buf, values, descs->ndescs); +} + +static void gpio_virtuser_set_value_array_atomic(struct irq_work *work) +{ + struct gpio_virtuser_irq_work_context *ctx = + to_gpio_virtuser_irq_work_context(work); + struct gpio_descs *descs = ctx->descs; + + ctx->ret = gpiod_set_array_value(descs->ndescs, descs->desc, + descs->info, ctx->values); + complete(&ctx->work_completion); +} + +static ssize_t +gpio_virtuser_sysfs_value_array_atomic_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t len) +{ + struct gpio_virtuser_line_array_data *data = to_gpio_virtuser_data(attr); + struct gpio_virtuser_irq_work_context ctx; + struct gpio_descs *descs = data->descs; + int ret; + + unsigned long *values __free(bitmap) = bitmap_zalloc(descs->ndescs, + GFP_KERNEL); + if (!values) + return -ENOMEM; + + ret = gpio_virtuser_sysfs_parse_value_array(buf, descs->ndescs, values); + if (ret) + return ret; + + gpio_virtuser_init_irq_work_context(&ctx); + ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_set_value_array_atomic); + ctx.descs = data->descs; + ctx.values = values; + + gpio_virtuser_irq_work_queue_sync(&ctx); + + if (ctx.ret) + return ctx.ret; + + return len; +} + +static ssize_t gpio_virtuser_emit_direction(char *buf, int dir) +{ + return sysfs_emit(buf, "%s\n", + dir == GPIO_LINE_DIRECTION_IN ? "input" : "output"); +} + +static int gpio_virtuser_set_direction(struct gpio_desc *desc, int dir, int val) +{ + if (dir == GPIO_LINE_DIRECTION_IN) + return gpiod_direction_input(desc); + + return gpiod_direction_output(desc, val); +} + +static int gpio_virtuser_parse_direction(const char *buf, int *dir, int *val) +{ + if (sysfs_streq(buf, "input")) { + *dir = GPIO_LINE_DIRECTION_IN; + return 0; + } + + if (sysfs_streq(buf, "output-high")) + *val = 1; + else if (sysfs_streq(buf, "output-low")) + *val = 0; + else + return -EINVAL; + + *dir = GPIO_LINE_DIRECTION_OUT; + return 0; +} + +static ssize_t +gpio_virtuser_sysfs_direction_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + int dir; + + dir = gpiod_get_direction(data->desc); + if (dir < 0) + return dir; + + return gpio_virtuser_emit_direction(buf, dir); +} + +static ssize_t +gpio_virtuser_sysfs_direction_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t len) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + int ret, dir, val; + + ret = gpio_virtuser_parse_direction(buf, &dir, &val); + if (ret) + return ret; + + ret = gpio_virtuser_set_direction(data->desc, dir, val); + if (ret) + return ret; + + return len; +} + +static void gpio_virtuser_get_direction_atomic(struct irq_work *work) +{ + struct gpio_virtuser_irq_work_context *ctx = + to_gpio_virtuser_irq_work_context(work); + + ctx->dir = gpiod_get_direction(ctx->desc); + + complete(&ctx->work_completion); +} + +static ssize_t +gpio_virtuser_sysfs_direction_atomic_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + struct gpio_virtuser_irq_work_context ctx; + + gpio_virtuser_init_irq_work_context(&ctx); + ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_get_direction_atomic); + ctx.desc = data->desc; + + gpio_virtuser_irq_work_queue_sync(&ctx); + + return gpio_virtuser_emit_direction(buf, ctx.dir); +} + +static void gpio_virtuser_set_direction_atomic(struct irq_work *work) +{ + struct gpio_virtuser_irq_work_context *ctx = + to_gpio_virtuser_irq_work_context(work); + + ctx->ret = gpio_virtuser_set_direction(ctx->desc, ctx->dir, ctx->val); + complete(&ctx->work_completion); +} + +static ssize_t +gpio_virtuser_sysfs_direction_atomic_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t len) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + struct gpio_virtuser_irq_work_context ctx; + int ret, dir, val; + + ret = gpio_virtuser_parse_direction(buf, &dir, &val); + if (ret) + return ret; + + gpio_virtuser_init_irq_work_context(&ctx); + ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_set_direction_atomic); + ctx.desc = data->desc; + ctx.dir = dir; + ctx.val = val; + + gpio_virtuser_irq_work_queue_sync(&ctx); + + return len; +} + +static const char *const gpio_virtuser_sysfs_value_strings[] = { + [0] = "inactive", + [1] = "active", +}; + +static ssize_t gpio_virtuser_emit_value(char *buf, int value) +{ + return sysfs_emit(buf, "%s\n", + gpio_virtuser_sysfs_value_strings[value]); +} + +static int gpio_virtuser_parse_value(const char *buf) +{ + int value, ret; + + value = sysfs_match_string(gpio_virtuser_sysfs_value_strings, buf); + if (value < 0) { + /* Can be 0 or 1 too. */ + ret = kstrtoint(buf, 0, &value); + if (ret) + return ret; + if (value != 0 && value != 1) + return -EINVAL; + } + + return value; +} + +static ssize_t +gpio_virtuser_sysfs_value_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + int value; + + value = gpiod_get_value_cansleep(data->desc); + if (value < 0) + return value; + + return gpio_virtuser_emit_value(buf, value); +} + +static ssize_t +gpio_virtuser_sysfs_value_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t len) +{ + + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + int value; + + value = gpio_virtuser_parse_value(buf); + if (value < 0) + return value; + + gpiod_set_value_cansleep(data->desc, value); + + return len; +} + +static void gpio_virtuser_get_value_atomic(struct irq_work *work) +{ + struct gpio_virtuser_irq_work_context *ctx = + to_gpio_virtuser_irq_work_context(work); + + ctx->val = gpiod_get_value(ctx->desc); + complete(&ctx->work_completion); +} + +static ssize_t +gpio_virtuser_sysfs_value_atomic_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + struct gpio_virtuser_irq_work_context ctx; + + gpio_virtuser_init_irq_work_context(&ctx); + ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_get_value_atomic); + ctx.desc = data->desc; + + gpio_virtuser_irq_work_queue_sync(&ctx); + + return gpio_virtuser_emit_value(buf, ctx.val); +} + +static void gpio_virtuser_set_value_atomic(struct irq_work *work) +{ + struct gpio_virtuser_irq_work_context *ctx = + to_gpio_virtuser_irq_work_context(work); + + gpiod_set_value(ctx->desc, ctx->val); + complete(&ctx->work_completion); +} + +static ssize_t +gpio_virtuser_sysfs_value_atomic_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t len) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + struct gpio_virtuser_irq_work_context ctx; + int val; + + val = gpio_virtuser_parse_value(buf); + if (val < 0) + return val; + + gpio_virtuser_init_irq_work_context(&ctx); + ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_set_value_atomic); + ctx.desc = data->desc; + ctx.val = val; + + gpio_virtuser_irq_work_queue_sync(&ctx); + + return len; +} + +static ssize_t +gpio_virtuser_sysfs_debounce_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + + return sysfs_emit(buf, "%u\n", READ_ONCE(data->debounce)); +} + +static ssize_t +gpio_virtuser_sysfs_debounce_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t len) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + unsigned int debounce; + int ret; + + ret = kstrtouint(buf, 10, &debounce); + if (ret) + return ret; + + ret = gpiod_set_debounce(data->desc, debounce); + if (ret) + return ret; + + WRITE_ONCE(data->debounce, debounce); + + return len; +} + +static ssize_t +gpio_virtuser_sysfs_consumer_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + + guard(mutex)(&data->consumer_lock); + + return sysfs_emit(buf, "%s\n", data->consumer); +} + +static ssize_t +gpio_virtuser_sysfs_consumer_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t len) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + int ret; + + if (strlen(buf) > GPIO_CONSUMER_NAME_MAX_LEN) + return -EINVAL; + + guard(mutex)(&data->consumer_lock); + + ret = gpiod_set_consumer_name(data->desc, buf); + if (ret) + return ret; + + sprintf(data->consumer, buf); + + return len; +} + +static ssize_t +gpio_virtuser_sysfs_interrupts_show(struct device *dev, + struct device_attribute *attr, char *buf) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + + return sysfs_emit(buf, "%u\n", atomic_read(&data->irq_count)); +} + +static irqreturn_t gpio_virtuser_irq_handler(int irq, void *data) +{ + struct gpio_virtuser_line_data *line = data; + + atomic_inc(&line->irq_count); + + return IRQ_HANDLED; +} + +static ssize_t +gpio_virtuser_sysfs_interrupts_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t len) +{ + struct gpio_virtuser_line_data *data = to_gpio_virtuser_data(attr); + int ret, irq; + bool enable; + + ret = kstrtobool(buf, &enable); + if (ret) + return ret; + + if (enable) { + irq = gpiod_to_irq(data->desc); + if (irq < 0) + return irq; + + ret = request_threaded_irq(irq, NULL, + gpio_virtuser_irq_handler, + IRQF_TRIGGER_RISING | + IRQF_TRIGGER_FALLING | + IRQF_ONESHOT, + data->consumer, data); + if (ret) + return ret; + + atomic_set(&data->irq, irq); + } else { + irq = atomic_xchg(&data->irq, 0); + free_irq(irq, data); + } + + return len; +} + +static const struct gpio_virtuser_attr_descr gpio_virtuser_line_array_attrs[] = { + [GPIO_CONSUMER_LINE_ARRAY_ATTR_VALUES] = { + .name = "values", + .show = gpio_virtuser_sysfs_value_array_show, + .store = gpio_virtuser_sysfs_value_array_store, + }, + [GPIO_CONSUMER_LINE_ARRAY_ATTR_VALUES_ATOMIC] = { + .name = "values_atomic", + .show = gpio_virtuser_sysfs_value_array_atomic_show, + .store = gpio_virtuser_sysfs_value_array_atomic_store, + }, +}; + +static const struct gpio_virtuser_attr_descr gpio_virtuser_line_attrs[] = { + [GPIO_CONSUMER_LINE_ATTR_DIRECTION] = { + .name = "direction", + .show = gpio_virtuser_sysfs_direction_show, + .store = gpio_virtuser_sysfs_direction_store, + }, + [GPIO_CONSUMER_LINE_ATTR_DIRECTION_ATOMIC] = { + .name = "direction_atomic", + .show = gpio_virtuser_sysfs_direction_atomic_show, + .store = gpio_virtuser_sysfs_direction_atomic_store, + }, + [GPIO_CONSUMER_LINE_ATTR_VALUE] = { + .name = "value", + .show = gpio_virtuser_sysfs_value_show, + .store = gpio_virtuser_sysfs_value_store, + }, + [GPIO_CONSUMER_LINE_ATTR_VALUE_ATOMIC] = { + .name = "value_atomic", + .show = gpio_virtuser_sysfs_value_atomic_show, + .store = gpio_virtuser_sysfs_value_atomic_store, + }, + [GPIO_CONSUMER_LINE_ATTR_DEBOUNCE] = { + .name = "debounce", + .show = gpio_virtuser_sysfs_debounce_show, + .store = gpio_virtuser_sysfs_debounce_store, + }, + [GPIO_CONSUMER_LINE_ATTR_CONSUMER] = { + .name = "consumer", + .show = gpio_virtuser_sysfs_consumer_show, + .store = gpio_virtuser_sysfs_consumer_store, + }, + [GPIO_CONSUMER_LINE_ATTR_INTERRUPTS] = { + .name = "interrupts", + .show = gpio_virtuser_sysfs_interrupts_show, + .store = gpio_virtuser_sysfs_interrupts_store, + }, +}; + +static void gpio_virtuser_line_array_attr_remove(void *data) +{ + struct gpio_virtuser_line_array_data *lines = data; + + sysfs_remove_group(lines->kobj, lines->attr_group); +} + +static void gpio_virtuser_line_attr_remove(void *data) +{ + struct gpio_virtuser_line_data *line = data; + + sysfs_remove_group(line->kobj, line->attr_group); +} + +static struct attribute * +gpio_virtuser_make_attribute(struct device *dev, void *data, + const struct gpio_virtuser_attr_descr *descr) +{ + struct gpio_virtuser_attr_ctx *ctx; + + ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL); + if (!ctx) + return ERR_PTR(-ENOMEM); + + ctx->data = data; + sysfs_attr_init(&ctx->dev_attr.attr); + ctx->dev_attr.attr.name = descr->name; + ctx->dev_attr.attr.mode = 0644; + ctx->dev_attr.show = descr->show; + ctx->dev_attr.store = descr->store; + + return &ctx->dev_attr.attr; +} + +static int gpio_virtuser_sysfs_init_line_array_attrs(struct device *dev, + struct gpio_descs *descs, + const char *id) + +{ + struct gpio_virtuser_line_array_data *data; + struct attribute **attrs; + unsigned int i; + int ret; + + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); + if (!data) + return -ENOMEM; + + data->kobj = &dev->kobj; + data->descs = descs; + + data->attr_group = devm_kzalloc(dev, sizeof(*data->attr_group), + GFP_KERNEL); + if (!data->attr_group) + return -ENOMEM; + + data->attr_group->name = devm_kasprintf(dev, GFP_KERNEL, + "gpiod:%s", id); + if (!data->attr_group->name) + return -ENOMEM; + + attrs = devm_kcalloc(dev, GPIO_CONSUMER_LINE_ARRAY_ATTR_COUNT + 1, + sizeof(*attrs), GFP_KERNEL); + if (!attrs) + return -ENOMEM; + + for (i = 0; i < GPIO_CONSUMER_LINE_ARRAY_ATTR_COUNT; i++) { + attrs[i] = gpio_virtuser_make_attribute(dev, data, + &gpio_virtuser_line_array_attrs[i]); + if (IS_ERR(attrs[i])) + return PTR_ERR(attrs[i]); + } + + data->attr_group->attrs = attrs; + ret = sysfs_create_group(&dev->kobj, data->attr_group); + if (ret) + return ret; + + return devm_add_action_or_reset(dev, + gpio_virtuser_line_array_attr_remove, + data); +} + +static void gpio_virtuser_mutex_destroy(void *data) +{ + struct mutex *lock = data; + + mutex_destroy(lock); +} + +static int gpio_virtuser_sysfs_init_line_attrs(struct device *dev, + struct gpio_desc *desc, + const char *id, + unsigned int index) +{ + struct gpio_virtuser_line_data *data; + struct attribute **attrs; + unsigned int i; + int ret; + + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); + if (!data) + return -ENOMEM; + + data->kobj = &dev->kobj; + data->desc = desc; + sprintf(data->consumer, id); + atomic_set(&data->irq, 0); + atomic_set(&data->irq_count, 0); + mutex_init(&data->consumer_lock); + + ret = devm_add_action_or_reset(dev, gpio_virtuser_mutex_destroy, + &data->consumer_lock); + if (ret) + return ret; + + data->attr_group = devm_kzalloc(dev, sizeof(*data->attr_group), + GFP_KERNEL); + if (!data->attr_group) + return -ENOMEM; + + data->attr_group->name = devm_kasprintf(dev, GFP_KERNEL, "gpiod:%s:%u", + id, index); + if (!data->attr_group->name) + return -ENOMEM; + + attrs = devm_kcalloc(dev, GPIO_CONSUMER_LINE_ATTR_COUNT + 1, + sizeof(*attrs), GFP_KERNEL); + if (!attrs) + return -ENOMEM; + + for (i = 0; i < GPIO_CONSUMER_LINE_ATTR_COUNT; i++) { + attrs[i] = gpio_virtuser_make_attribute(dev, data, + &gpio_virtuser_line_attrs[i]); + if (IS_ERR(attrs[i])) + return PTR_ERR(attrs[i]); + } + + data->attr_group->attrs = attrs; + ret = sysfs_create_group(&dev->kobj, data->attr_group); + if (ret) + return ret; + + return devm_add_action_or_reset(dev, gpio_virtuser_line_attr_remove, + data); +} + +static int gpio_virtuser_prop_is_gpio(struct property *prop) +{ + char *dash = strpbrk(prop->name, "-"); + + return dash && strcmp(dash, "-gpios") == 0; +} + +/* + * If this is an OF-based system, then we iterate over properties and consider + * all whose names end in "-gpios". For configfs we expect an additional string + * array property - "gpio-virtuser,ids" - containing the list of all GPIO IDs + * to request. + */ +static int gpio_virtuser_count_ids(struct device *dev) +{ + struct fwnode_handle *fwnode = dev_fwnode(dev); + struct property *prop; + int ret = 0; + + if (is_of_node(fwnode)) { + for_each_property_of_node(to_of_node(fwnode), prop) { + if (gpio_virtuser_prop_is_gpio(prop)) + ++ret; + } + + return ret; + } + + return device_property_string_array_count(dev, "gpio-virtuser,ids"); +} + +static int gpio_virtuser_get_ids(struct device *dev, const char **ids, + int num_ids) +{ + struct fwnode_handle *fwnode = dev_fwnode(dev); + struct property *prop; + size_t pos = 0, diff; + char *dash, *tmp; + + if (is_of_node(fwnode)) { + for_each_property_of_node(to_of_node(fwnode), prop) { + if (!gpio_virtuser_prop_is_gpio(prop)) + continue; + + dash = strpbrk(prop->name, "-"); + diff = dash - prop->name; + + tmp = devm_kmemdup(dev, prop->name, diff + 1, + GFP_KERNEL); + if (!tmp) + return -ENOMEM; + + tmp[diff] = '\0'; + ids[pos++] = tmp; + } + + return 0; + } + + return device_property_read_string_array(dev, "gpio-virtuser,ids", + ids, num_ids); +} + +static int gpio_virtuser_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct gpio_descs *descs; + int ret, num_ids = 0, i; + const char **ids; + unsigned int j; + + num_ids = gpio_virtuser_count_ids(dev); + if (num_ids < 0) + return dev_err_probe(dev, num_ids, + "Failed to get the number of GPIOs to request\n"); + + if (num_ids == 0) { + dev_err(dev, "No GPIO IDs specified\n"); + return -EINVAL; + } + + ids = devm_kcalloc(dev, num_ids, sizeof(*ids), GFP_KERNEL); + if (!ids) + return -ENOMEM; + + ret = gpio_virtuser_get_ids(dev, ids, num_ids); + if (ret < 0) + return dev_err_probe(dev, ret, + "Failed to get the IDs of GPIOs to request\n"); + + for (i = 0; i < num_ids; i++) { + descs = devm_gpiod_get_array(dev, ids[i], GPIOD_ASIS); + if (IS_ERR(descs)) + return dev_err_probe(dev, PTR_ERR(descs), + "Failed to request the '%s' GPIOs\n", + ids[i]); + + ret = gpio_virtuser_sysfs_init_line_array_attrs(dev, descs, + ids[i]); + if (ret) + return dev_err_probe(dev, ret, + "Failed to setup the sysfs array interface for the '%s' GPIOs\n", + ids[i]); + + for (j = 0; j < descs->ndescs; j++) { + ret = gpio_virtuser_sysfs_init_line_attrs(dev, + descs->desc[j], + ids[i], j); + if (ret) + return dev_err_probe(dev, ret, + "Failed to setup the sysfs line interface for the '%s' GPIOs\n", + ids[i]); + } + } + + return 0; +} + +static const struct of_device_id gpio_virtuser_of_match[] = { + { .compatible = "gpio-virtuser" }, + { } +}; +MODULE_DEVICE_TABLE(of, gpio_virtuser_of_match); + +static struct platform_driver gpio_virtuser_driver = { + .driver = { + .name = "gpio-virtuser", + .of_match_table = gpio_virtuser_of_match, + }, + .probe = gpio_virtuser_probe, +}; + +struct gpio_virtuser_device { + struct config_group group; + + struct platform_device *pdev; + int id; + struct mutex lock; + + struct notifier_block bus_notifier; + struct completion probe_completion; + bool driver_bound; + + struct gpiod_lookup_table *lookup_table; + + struct list_head lookup_list; +}; + +static int gpio_virtuser_bus_notifier_call(struct notifier_block *nb, + unsigned long action, void *data) +{ + struct gpio_virtuser_device *vdev; + struct device *dev = data; + char devname[32]; + + vdev = container_of(nb, struct gpio_virtuser_device, bus_notifier); + snprintf(devname, sizeof(devname), "gpio-virtuser.%d", vdev->id); + + if (strcmp(dev_name(dev), devname)) + return NOTIFY_DONE; + + switch (action) { + case BUS_NOTIFY_BOUND_DRIVER: + vdev->driver_bound = true; + break; + case BUS_NOTIFY_DRIVER_NOT_BOUND: + vdev->driver_bound = false; + break; + default: + return NOTIFY_DONE; + } + + complete(&vdev->probe_completion); + return NOTIFY_OK; +} + +static struct gpio_virtuser_device * +to_gpio_virtuser_device(struct config_item *item) +{ + struct config_group *group = to_config_group(item); + + return container_of(group, struct gpio_virtuser_device, group); +} + +static bool +gpio_virtuser_device_is_live(struct gpio_virtuser_device *dev) +{ + lockdep_assert_held(&dev->lock); + + return !!dev->pdev; +} + +struct gpio_virtuser_lookup { + struct config_group group; + + struct gpio_virtuser_device *parent; + struct list_head siblings; + + char *con_id; + + struct list_head entry_list; +}; + +static struct gpio_virtuser_lookup * +to_gpio_virtuser_lookup(struct config_item *item) +{ + struct config_group *group = to_config_group(item); + + return container_of(group, struct gpio_virtuser_lookup, group); +} + +struct gpio_virtuser_lookup_entry { + struct config_group group; + + struct gpio_virtuser_lookup *parent; + struct list_head siblings; + + char *key; + /* Can be negative to indicate lookup by name. */ + int offset; + enum gpio_lookup_flags flags; +}; + +static struct gpio_virtuser_lookup_entry * +to_gpio_virtuser_lookup_entry(struct config_item *item) +{ + struct config_group *group = to_config_group(item); + + return container_of(group, struct gpio_virtuser_lookup_entry, group); +} + +static ssize_t +gpio_virtuser_lookup_entry_config_key_show(struct config_item *item, char *page) +{ + struct gpio_virtuser_lookup_entry *entry = + to_gpio_virtuser_lookup_entry(item); + struct gpio_virtuser_device *dev = entry->parent->parent; + + guard(mutex)(&dev->lock); + + return sprintf(page, "%s\n", entry->key ?: ""); +} + +static ssize_t +gpio_virtuser_lookup_entry_config_key_store(struct config_item *item, + const char *page, size_t count) +{ + struct gpio_virtuser_lookup_entry *entry = + to_gpio_virtuser_lookup_entry(item); + struct gpio_virtuser_device *dev = entry->parent->parent; + + char *key = kstrndup(skip_spaces(page), count, GFP_KERNEL); + if (!key) + return -ENOMEM; + + strim(key); + + guard(mutex)(&dev->lock); + + if (gpio_virtuser_device_is_live(dev)) + return -EBUSY; + + kfree(entry->key); + entry->key = no_free_ptr(key); + + return count; +} + +CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, key); + +static ssize_t +gpio_virtuser_lookup_entry_config_offset_show(struct config_item *item, + char *page) +{ + struct gpio_virtuser_lookup_entry *entry = + to_gpio_virtuser_lookup_entry(item); + struct gpio_virtuser_device *dev = entry->parent->parent; + unsigned int offset; + + scoped_guard(mutex, &dev->lock) + offset = entry->offset; + + return sprintf(page, "%d\n", offset); +} + +static ssize_t +gpio_virtuser_lookup_entry_config_offset_store(struct config_item *item, + const char *page, size_t count) +{ + struct gpio_virtuser_lookup_entry *entry = + to_gpio_virtuser_lookup_entry(item); + struct gpio_virtuser_device *dev = entry->parent->parent; + int offset, ret; + + ret = kstrtoint(page, 0, &offset); + if (ret) + return ret; + + /* + * Negative number here means: 'key' represents a line name to lookup. + * Non-negative means: 'key' represents the label of the chip with + * the 'offset' value representing the line within that chip. + * + * GPIOLIB uses the U16_MAX value to indicate lookup by line name so + * the greatest offset we can accept is (U16_MAX - 1). + */ + if (offset > (U16_MAX - 1)) + return -EINVAL; + + guard(mutex)(&dev->lock); + + if (gpio_virtuser_device_is_live(dev)) + return -EBUSY; + + entry->offset = offset; + + return count; +} + +CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, offset); + +static enum gpio_lookup_flags +gpio_virtuser_lookup_get_flags(struct config_item *item) +{ + struct gpio_virtuser_lookup_entry *entry = + to_gpio_virtuser_lookup_entry(item); + struct gpio_virtuser_device *dev = entry->parent->parent; + + guard(mutex)(&dev->lock); + + return entry->flags; +} + +static ssize_t +gpio_virtuser_lookup_entry_config_drive_show(struct config_item *item, char *page) +{ + enum gpio_lookup_flags flags = gpio_virtuser_lookup_get_flags(item); + const char *repr; + + if (flags & GPIO_OPEN_DRAIN) + repr = "open-drain"; + else if (flags & GPIO_OPEN_SOURCE) + repr = "open-source"; + else + repr = "push-pull"; + + return sprintf(page, "%s\n", repr); +} + +static ssize_t +gpio_virtuser_lookup_entry_config_drive_store(struct config_item *item, + const char *page, size_t count) +{ + struct gpio_virtuser_lookup_entry *entry = + to_gpio_virtuser_lookup_entry(item); + struct gpio_virtuser_device *dev = entry->parent->parent; + + guard(mutex)(&dev->lock); + + if (gpio_virtuser_device_is_live(dev)) + return -EBUSY; + + if (sysfs_streq(page, "push-pull")) { + entry->flags &= ~(GPIO_OPEN_DRAIN | GPIO_OPEN_SOURCE); + } else if (sysfs_streq(page, "open-drain")) { + entry->flags &= ~GPIO_OPEN_SOURCE; + entry->flags |= GPIO_OPEN_DRAIN; + } else if (sysfs_streq(page, "open-source")) { + entry->flags &= ~GPIO_OPEN_DRAIN; + entry->flags |= GPIO_OPEN_SOURCE; + } else { + count = -EINVAL; + } + + return count; +} + +CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, drive); + +static ssize_t +gpio_virtuser_lookup_entry_config_pull_show(struct config_item *item, char *page) +{ + enum gpio_lookup_flags flags = gpio_virtuser_lookup_get_flags(item); + const char *repr; + + if (flags & GPIO_PULL_UP) + repr = "pull-up"; + else if (flags & GPIO_PULL_DOWN) + repr = "pull-down"; + else if (flags & GPIO_PULL_DISABLE) + repr = "pull-disabled"; + else + repr = "as-is"; + + return sprintf(page, "%s\n", repr); +} + +static ssize_t +gpio_virtuser_lookup_entry_config_pull_store(struct config_item *item, + const char *page, size_t count) +{ + struct gpio_virtuser_lookup_entry *entry = + to_gpio_virtuser_lookup_entry(item); + struct gpio_virtuser_device *dev = entry->parent->parent; + + guard(mutex)(&dev->lock); + + if (gpio_virtuser_device_is_live(dev)) + return -EBUSY; + + if (sysfs_streq(page, "pull-up")) { + entry->flags &= ~(GPIO_PULL_DOWN | GPIO_PULL_DISABLE); + entry->flags |= GPIO_PULL_UP; + } else if (sysfs_streq(page, "pull-down")) { + entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DISABLE); + entry->flags |= GPIO_PULL_DOWN; + } else if (sysfs_streq(page, "pull-disabled")) { + entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DOWN); + entry->flags |= GPIO_PULL_DISABLE; + } else if (sysfs_streq(page, "as-is")) { + entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DOWN | + GPIO_PULL_DISABLE); + } else { + count = -EINVAL; + } + + return count; +} + +CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, pull); + +static ssize_t +gpio_virtuser_lookup_entry_config_active_low_show(struct config_item *item, + char *page) +{ + enum gpio_lookup_flags flags = gpio_virtuser_lookup_get_flags(item); + + return sprintf(page, "%s\n", flags & GPIO_ACTIVE_LOW ? "1" : "0"); +} + +static ssize_t +gpio_virtuser_lookup_entry_config_active_low_store(struct config_item *item, + const char *page, + size_t count) +{ + struct gpio_virtuser_lookup_entry *entry = + to_gpio_virtuser_lookup_entry(item); + struct gpio_virtuser_device *dev = entry->parent->parent; + bool active_low; + int ret; + + ret = kstrtobool(page, &active_low); + if (ret) + return ret; + + guard(mutex)(&dev->lock); + + if (gpio_virtuser_device_is_live(dev)) + return -EBUSY; + + if (active_low) + entry->flags |= GPIO_ACTIVE_LOW; + else + entry->flags &= ~GPIO_ACTIVE_LOW; + + return count; +} + +CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, active_low); + +static ssize_t +gpio_virtuser_lookup_entry_config_transitory_show(struct config_item *item, + char *page) +{ + enum gpio_lookup_flags flags = gpio_virtuser_lookup_get_flags(item); + + return sprintf(page, "%s\n", flags & GPIO_TRANSITORY ? "1" : "0"); +} + +static ssize_t +gpio_virtuser_lookup_entry_config_transitory_store(struct config_item *item, + const char *page, + size_t count) +{ + struct gpio_virtuser_lookup_entry *entry = + to_gpio_virtuser_lookup_entry(item); + struct gpio_virtuser_device *dev = entry->parent->parent; + bool transitory; + int ret; + + ret = kstrtobool(page, &transitory); + if (ret) + return ret; + + guard(mutex)(&dev->lock); + + if (gpio_virtuser_device_is_live(dev)) + return -EBUSY; + + if (transitory) + entry->flags |= GPIO_TRANSITORY; + else + entry->flags &= ~GPIO_TRANSITORY; + + return count; +} + +CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, transitory); + +static struct configfs_attribute *gpio_virtuser_lookup_entry_config_attrs[] = { + &gpio_virtuser_lookup_entry_config_attr_key, + &gpio_virtuser_lookup_entry_config_attr_offset, + &gpio_virtuser_lookup_entry_config_attr_drive, + &gpio_virtuser_lookup_entry_config_attr_pull, + &gpio_virtuser_lookup_entry_config_attr_active_low, + &gpio_virtuser_lookup_entry_config_attr_transitory, + NULL +}; + +static ssize_t +gpio_virtuser_device_config_dev_name_show(struct config_item *item, + char *page) +{ + struct gpio_virtuser_device *dev = to_gpio_virtuser_device(item); + struct platform_device *pdev; + + guard(mutex)(&dev->lock); + + pdev = dev->pdev; + if (pdev) + return sprintf(page, "%s\n", dev_name(&pdev->dev)); + + return sprintf(page, "gpio-sim.%d\n", dev->id); +} + +CONFIGFS_ATTR_RO(gpio_virtuser_device_config_, dev_name); + +static ssize_t gpio_virtuser_device_config_live_show(struct config_item *item, + char *page) +{ + struct gpio_virtuser_device *dev = to_gpio_virtuser_device(item); + bool live; + + scoped_guard(mutex, &dev->lock) + live = gpio_virtuser_device_is_live(dev); + + return sprintf(page, "%c\n", live ? '1' : '0'); +} + +static size_t +gpio_virtuser_get_lookup_count(struct gpio_virtuser_device *dev) +{ + struct gpio_virtuser_lookup *lookup; + size_t count = 0; + + lockdep_assert_held(&dev->lock); + + list_for_each_entry(lookup, &dev->lookup_list, siblings) + count += list_count_nodes(&lookup->entry_list); + + return count; +} + +static int +gpio_virtuser_make_lookup_table(struct gpio_virtuser_device *dev) +{ + size_t num_entries = gpio_virtuser_get_lookup_count(dev); + struct gpio_virtuser_lookup_entry *entry; + struct gpio_virtuser_lookup *lookup; + struct gpiod_lookup *curr; + unsigned int i = 0; + + lockdep_assert_held(&dev->lock); + + struct gpiod_lookup_table *table __free(kfree) = + kzalloc(struct_size(table, table, num_entries + 1), GFP_KERNEL); + if (!table) + return -ENOMEM; + + table->dev_id = kasprintf(GFP_KERNEL, "gpio-virtuser.%d", + dev->id); + if (!table->dev_id) + return -ENOMEM; + + list_for_each_entry(lookup, &dev->lookup_list, siblings) { + list_for_each_entry(entry, &lookup->entry_list, siblings) { + curr = &table->table[i]; + + curr->con_id = lookup->con_id; + curr->idx = i; + curr->key = entry->key; + curr->chip_hwnum = entry->offset < 0 + ? U16_MAX : entry->offset; + curr->flags = entry->flags; + ++i; + } + } + + gpiod_add_lookup_table(table); + dev->lookup_table = no_free_ptr(table); + + return 0; +} + +static struct fwnode_handle * +gpio_virtuser_make_device_swnode(struct gpio_virtuser_device *dev) +{ + struct property_entry properties[2]; + struct gpio_virtuser_lookup *lookup; + size_t num_ids; + int i = 0; + + memset(properties, 0, sizeof(properties)); + + num_ids = list_count_nodes(&dev->lookup_list); + char **ids __free(kfree) = kcalloc(num_ids + 1, sizeof(*ids), + GFP_KERNEL); + if (!ids) + return ERR_PTR(-ENOMEM); + + list_for_each_entry(lookup, &dev->lookup_list, siblings) + ids[i++] = lookup->con_id; + + properties[0] = PROPERTY_ENTRY_STRING_ARRAY_LEN("gpio-virtuser,ids", + ids, num_ids); + + return fwnode_create_software_node(properties, NULL); +} + +static int +gpio_virtuser_device_activate(struct gpio_virtuser_device *dev) +{ + struct platform_device_info pdevinfo; + struct fwnode_handle *swnode; + struct platform_device *pdev; + int ret; + + lockdep_assert_held(&dev->lock); + + if (list_empty(&dev->lookup_list)) + return -ENODATA; + + swnode = gpio_virtuser_make_device_swnode(dev); + if (IS_ERR(swnode)) + return PTR_ERR(swnode); + + memset(&pdevinfo, 0, sizeof(pdevinfo)); + pdevinfo.name = "gpio-virtuser"; + pdevinfo.id = dev->id; + pdevinfo.fwnode = swnode; + + ret = gpio_virtuser_make_lookup_table(dev); + if (ret) { + fwnode_remove_software_node(swnode); + return ret; + } + + reinit_completion(&dev->probe_completion); + dev->driver_bound = false; + bus_register_notifier(&platform_bus_type, &dev->bus_notifier); + + pdev = platform_device_register_full(&pdevinfo); + if (IS_ERR(pdev)) { + bus_unregister_notifier(&platform_bus_type, &dev->bus_notifier); + fwnode_remove_software_node(swnode); + return PTR_ERR(pdev); + } + + wait_for_completion(&dev->probe_completion); + bus_unregister_notifier(&platform_bus_type, &dev->bus_notifier); + + if (!dev->driver_bound) { + platform_device_unregister(pdev); + fwnode_remove_software_node(swnode); + return -ENXIO; + } + + dev->pdev = pdev; + + return 0; +} + +static void +gpio_virtuser_device_deactivate(struct gpio_virtuser_device *dev) +{ + struct fwnode_handle *swnode; + + lockdep_assert_held(&dev->lock); + + swnode = dev_fwnode(&dev->pdev->dev); + platform_device_unregister(dev->pdev); + fwnode_remove_software_node(swnode); + dev->pdev = NULL; + gpiod_remove_lookup_table(dev->lookup_table); + kfree(dev->lookup_table); +} + +static ssize_t +gpio_virtuser_device_config_live_store(struct config_item *item, + const char *page, size_t count) +{ + struct gpio_virtuser_device *dev = to_gpio_virtuser_device(item); + bool live; + int ret; + + ret = kstrtobool(page, &live); + if (ret) + return ret; + + guard(mutex)(&dev->lock); + + if (live == gpio_virtuser_device_is_live(dev)) + ret = -EPERM; + else if (live) + ret = gpio_virtuser_device_activate(dev); + else + gpio_virtuser_device_deactivate(dev); + + return ret ?: count; +} + +CONFIGFS_ATTR(gpio_virtuser_device_config_, live); + +static struct configfs_attribute *gpio_virtuser_device_config_attrs[] = { + &gpio_virtuser_device_config_attr_dev_name, + &gpio_virtuser_device_config_attr_live, + NULL +}; + +static void +gpio_virtuser_lookup_entry_config_group_release(struct config_item *item) +{ + struct gpio_virtuser_lookup_entry *entry = + to_gpio_virtuser_lookup_entry(item); + struct gpio_virtuser_device *dev = entry->parent->parent; + + guard(mutex)(&dev->lock); + + list_del(&entry->siblings); + + kfree(entry->key); + kfree(entry); +} + +static struct +configfs_item_operations gpio_virtuser_lookup_entry_config_item_ops = { + .release = gpio_virtuser_lookup_entry_config_group_release, +}; + +static const struct +config_item_type gpio_virtuser_lookup_entry_config_group_type = { + .ct_item_ops = &gpio_virtuser_lookup_entry_config_item_ops, + .ct_attrs = gpio_virtuser_lookup_entry_config_attrs, + .ct_owner = THIS_MODULE, +}; + +static struct config_group * +gpio_virtuser_make_lookup_entry_group(struct config_group *group, + const char *name) +{ + struct gpio_virtuser_lookup *lookup = + to_gpio_virtuser_lookup(&group->cg_item); + struct gpio_virtuser_device *dev = lookup->parent; + + guard(mutex)(&dev->lock); + + if (gpio_virtuser_device_is_live(dev)) + return ERR_PTR(-EBUSY); + + struct gpio_virtuser_lookup_entry *entry __free(kfree) = + kzalloc(sizeof(*entry), GFP_KERNEL); + if (!entry) + return ERR_PTR(-ENOMEM); + + config_group_init_type_name(&entry->group, name, + &gpio_virtuser_lookup_entry_config_group_type); + entry->flags = GPIO_LOOKUP_FLAGS_DEFAULT; + entry->parent = lookup; + list_add_tail(&entry->siblings, &lookup->entry_list); + + return &no_free_ptr(entry)->group; +} + +static void gpio_virtuser_lookup_config_group_release(struct config_item *item) +{ + struct gpio_virtuser_lookup *lookup = to_gpio_virtuser_lookup(item); + struct gpio_virtuser_device *dev = lookup->parent; + + guard(mutex)(&dev->lock); + + list_del(&lookup->siblings); + + kfree(lookup->con_id); + kfree(lookup); +} + +static struct configfs_item_operations gpio_virtuser_lookup_config_item_ops = { + .release = gpio_virtuser_lookup_config_group_release, +}; + +static struct +configfs_group_operations gpio_virtuser_lookup_config_group_ops = { + .make_group = gpio_virtuser_make_lookup_entry_group, +}; + +static const struct config_item_type gpio_virtuser_lookup_config_group_type = { + .ct_group_ops = &gpio_virtuser_lookup_config_group_ops, + .ct_item_ops = &gpio_virtuser_lookup_config_item_ops, + .ct_owner = THIS_MODULE, +}; + +static struct config_group * +gpio_virtuser_make_lookup_group(struct config_group *group, const char *name) +{ + struct gpio_virtuser_device *dev = + to_gpio_virtuser_device(&group->cg_item); + + if (strlen(name) > GPIO_CONSUMER_NAME_MAX_LEN) + return ERR_PTR(-EINVAL); + + guard(mutex)(&dev->lock); + + if (gpio_virtuser_device_is_live(dev)) + return ERR_PTR(-EBUSY); + + struct gpio_virtuser_lookup *lookup __free(kfree) = + kzalloc(sizeof(*lookup), GFP_KERNEL); + if (!lookup) + return ERR_PTR(-ENOMEM); + + lookup->con_id = kstrdup(name, GFP_KERNEL); + if (!lookup->con_id) + return ERR_PTR(-ENOMEM); + + config_group_init_type_name(&lookup->group, name, + &gpio_virtuser_lookup_config_group_type); + INIT_LIST_HEAD(&lookup->entry_list); + lookup->parent = dev; + list_add_tail(&lookup->siblings, &dev->lookup_list); + + return &no_free_ptr(lookup)->group; +} + +static void gpio_virtuser_device_config_group_release(struct config_item *item) +{ + struct gpio_virtuser_device *dev = to_gpio_virtuser_device(item); + + guard(mutex)(&dev->lock); + + if (gpio_virtuser_device_is_live(dev)) + gpio_virtuser_device_deactivate(dev); + + mutex_destroy(&dev->lock); + ida_free(&gpio_virtuser_ida, dev->id); + kfree(dev); +} + +static struct configfs_item_operations gpio_virtuser_device_config_item_ops = { + .release = gpio_virtuser_device_config_group_release, +}; + +static struct configfs_group_operations gpio_virtuser_device_config_group_ops = { + .make_group = gpio_virtuser_make_lookup_group, +}; + +static const struct config_item_type gpio_virtuser_device_config_group_type = { + .ct_group_ops = &gpio_virtuser_device_config_group_ops, + .ct_item_ops = &gpio_virtuser_device_config_item_ops, + .ct_attrs = gpio_virtuser_device_config_attrs, + .ct_owner = THIS_MODULE, +}; + +static struct config_group * +gpio_virtuser_config_make_device_group(struct config_group *group, + const char *name) +{ + struct gpio_virtuser_device *dev __free(kfree) = kzalloc(sizeof(*dev), + GFP_KERNEL); + if (!dev) + return ERR_PTR(-ENOMEM); + + dev->id = ida_alloc(&gpio_virtuser_ida, GFP_KERNEL); + if (dev->id < 0) + return ERR_PTR(dev->id); + + config_group_init_type_name(&dev->group, name, + &gpio_virtuser_device_config_group_type); + mutex_init(&dev->lock); + INIT_LIST_HEAD(&dev->lookup_list); + dev->bus_notifier.notifier_call = gpio_virtuser_bus_notifier_call; + init_completion(&dev->probe_completion); + + return &no_free_ptr(dev)->group; +} + +static struct configfs_group_operations gpio_virtuser_config_group_ops = { + .make_group = gpio_virtuser_config_make_device_group, +}; + +static const struct config_item_type gpio_virtuser_config_type = { + .ct_group_ops = &gpio_virtuser_config_group_ops, + .ct_owner = THIS_MODULE, +}; + +static struct configfs_subsystem gpio_virtuser_config_subsys = { + .su_group = { + .cg_item = { + .ci_namebuf = "gpio-virtuser", + .ci_type = &gpio_virtuser_config_type, + }, + }, +}; + +static int __init gpio_virtuser_init(void) +{ + int ret; + + ret = platform_driver_register(&gpio_virtuser_driver); + if (ret) { + pr_err("Failed to register the platform driver: %d\n", + ret); + return ret; + } + + config_group_init(&gpio_virtuser_config_subsys.su_group); + mutex_init(&gpio_virtuser_config_subsys.su_mutex); + ret = configfs_register_subsystem(&gpio_virtuser_config_subsys); + if (ret) { + pr_err("Failed to register the '%s' configfs subsystem: %d\n", + gpio_virtuser_config_subsys.su_group.cg_item.ci_namebuf, + ret); + mutex_destroy(&gpio_virtuser_config_subsys.su_mutex); + platform_driver_unregister(&gpio_virtuser_driver); + return ret; + } + + return 0; +} +module_init(gpio_virtuser_init); + +static void __exit gpio_virtuser_exit(void) +{ + configfs_unregister_subsystem(&gpio_virtuser_config_subsys); + mutex_destroy(&gpio_virtuser_config_subsys.su_mutex); + platform_driver_unregister(&gpio_virtuser_driver); +} +module_exit(gpio_virtuser_exit); + +MODULE_AUTHOR("Bartosz Golaszewski <bartosz.golaszewski@linaro.org>"); +MODULE_DESCRIPTION("Virtual GPIO consumer module"); +MODULE_LICENSE("GPL");