Lines Matching +full:int +full:- +full:fwd +full:- +full:mask
1 // SPDX-License-Identifier: GPL-2.0-only
5 // Copyright (C) 2019-2020 Glider bv
7 #define DRV_NAME "gpio-aggregator"
45 static int aggr_add_gpio(struct gpio_aggregator *aggr, const char *key, in aggr_add_gpio()
46 int hwnum, unsigned int *n) in aggr_add_gpio()
50 lookups = krealloc(aggr->lookups, struct_size(lookups, table, *n + 2), in aggr_add_gpio()
53 return -ENOMEM; in aggr_add_gpio()
55 lookups->table[*n] = GPIO_LOOKUP_IDX(key, hwnum, NULL, *n, 0); in aggr_add_gpio()
58 memset(&lookups->table[*n], 0, sizeof(lookups->table[*n])); in aggr_add_gpio()
60 aggr->lookups = lookups; in aggr_add_gpio()
64 static int aggr_parse(struct gpio_aggregator *aggr) in aggr_parse()
66 char *args = skip_spaces(aggr->args); in aggr_parse()
68 unsigned int i, n = 0; in aggr_parse()
69 int error = 0; in aggr_parse()
74 return -ENOMEM; in aggr_parse()
109 return -EINVAL; in aggr_parse()
120 int res, id; in new_device_store()
123 return -ENOENT; in new_device_store()
128 res = -ENOMEM; in new_device_store()
132 memcpy(aggr->args, buf, count + 1); in new_device_store()
134 aggr->lookups = kzalloc(struct_size(aggr->lookups, table, 1), in new_device_store()
136 if (!aggr->lookups) { in new_device_store()
137 res = -ENOMEM; in new_device_store()
150 aggr->lookups->dev_id = kasprintf(GFP_KERNEL, "%s.%d", DRV_NAME, id); in new_device_store()
151 if (!aggr->lookups->dev_id) { in new_device_store()
152 res = -ENOMEM; in new_device_store()
160 gpiod_add_lookup_table(aggr->lookups); in new_device_store()
168 aggr->pdev = pdev; in new_device_store()
173 gpiod_remove_lookup_table(aggr->lookups); in new_device_store()
175 kfree(aggr->lookups->dev_id); in new_device_store()
181 kfree(aggr->lookups); in new_device_store()
193 platform_device_unregister(aggr->pdev); in gpio_aggregator_free()
194 gpiod_remove_lookup_table(aggr->lookups); in gpio_aggregator_free()
195 kfree(aggr->lookups->dev_id); in gpio_aggregator_free()
196 kfree(aggr->lookups); in gpio_aggregator_free()
204 unsigned int id; in delete_device_store()
205 int error; in delete_device_store()
208 return -EINVAL; in delete_device_store()
215 return -ENOENT; in delete_device_store()
222 return -ENOENT; in delete_device_store()
238 static int __exit gpio_aggregator_idr_remove(int id, void *p, void *data) in gpio_aggregator_idr_remove()
273 #define fwd_tmp_values(fwd) &(fwd)->tmp[0] argument
274 #define fwd_tmp_descs(fwd) (void *)&(fwd)->tmp[BITS_TO_LONGS((fwd)->chip.ngpio)] argument
278 static int gpio_fwd_get_direction(struct gpio_chip *chip, unsigned int offset) in gpio_fwd_get_direction()
280 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpio_fwd_get_direction() local
282 return gpiod_get_direction(fwd->descs[offset]); in gpio_fwd_get_direction()
285 static int gpio_fwd_direction_input(struct gpio_chip *chip, unsigned int offset) in gpio_fwd_direction_input()
287 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpio_fwd_direction_input() local
289 return gpiod_direction_input(fwd->descs[offset]); in gpio_fwd_direction_input()
292 static int gpio_fwd_direction_output(struct gpio_chip *chip, in gpio_fwd_direction_output()
293 unsigned int offset, int value) in gpio_fwd_direction_output()
295 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpio_fwd_direction_output() local
297 return gpiod_direction_output(fwd->descs[offset], value); in gpio_fwd_direction_output()
300 static int gpio_fwd_get(struct gpio_chip *chip, unsigned int offset) in gpio_fwd_get()
302 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpio_fwd_get() local
304 return chip->can_sleep ? gpiod_get_value_cansleep(fwd->descs[offset]) in gpio_fwd_get()
305 : gpiod_get_value(fwd->descs[offset]); in gpio_fwd_get()
308 static int gpio_fwd_get_multiple(struct gpiochip_fwd *fwd, unsigned long *mask, in gpio_fwd_get_multiple() argument
311 struct gpio_desc **descs = fwd_tmp_descs(fwd); in gpio_fwd_get_multiple()
312 unsigned long *values = fwd_tmp_values(fwd); in gpio_fwd_get_multiple()
313 unsigned int i, j = 0; in gpio_fwd_get_multiple()
314 int error; in gpio_fwd_get_multiple()
316 bitmap_clear(values, 0, fwd->chip.ngpio); in gpio_fwd_get_multiple()
317 for_each_set_bit(i, mask, fwd->chip.ngpio) in gpio_fwd_get_multiple()
318 descs[j++] = fwd->descs[i]; in gpio_fwd_get_multiple()
320 if (fwd->chip.can_sleep) in gpio_fwd_get_multiple()
328 for_each_set_bit(i, mask, fwd->chip.ngpio) in gpio_fwd_get_multiple()
334 static int gpio_fwd_get_multiple_locked(struct gpio_chip *chip, in gpio_fwd_get_multiple_locked()
335 unsigned long *mask, unsigned long *bits) in gpio_fwd_get_multiple_locked() argument
337 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpio_fwd_get_multiple_locked() local
339 int error; in gpio_fwd_get_multiple_locked()
341 if (chip->can_sleep) { in gpio_fwd_get_multiple_locked()
342 mutex_lock(&fwd->mlock); in gpio_fwd_get_multiple_locked()
343 error = gpio_fwd_get_multiple(fwd, mask, bits); in gpio_fwd_get_multiple_locked()
344 mutex_unlock(&fwd->mlock); in gpio_fwd_get_multiple_locked()
346 spin_lock_irqsave(&fwd->slock, flags); in gpio_fwd_get_multiple_locked()
347 error = gpio_fwd_get_multiple(fwd, mask, bits); in gpio_fwd_get_multiple_locked()
348 spin_unlock_irqrestore(&fwd->slock, flags); in gpio_fwd_get_multiple_locked()
354 static void gpio_fwd_delay(struct gpio_chip *chip, unsigned int offset, int value) in gpio_fwd_delay()
356 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpio_fwd_delay() local
358 bool is_active_low = gpiod_is_active_low(fwd->descs[offset]); in gpio_fwd_delay()
361 delay_timings = &fwd->delay_timings[offset]; in gpio_fwd_delay()
363 delay_us = delay_timings->ramp_up_us; in gpio_fwd_delay()
365 delay_us = delay_timings->ramp_down_us; in gpio_fwd_delay()
369 if (chip->can_sleep) in gpio_fwd_delay()
375 static int gpio_fwd_set(struct gpio_chip *chip, unsigned int offset, int value) in gpio_fwd_set()
377 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpio_fwd_set() local
378 int ret; in gpio_fwd_set()
380 if (chip->can_sleep) in gpio_fwd_set()
381 ret = gpiod_set_value_cansleep(fwd->descs[offset], value); in gpio_fwd_set()
383 ret = gpiod_set_value(fwd->descs[offset], value); in gpio_fwd_set()
387 if (fwd->delay_timings) in gpio_fwd_set()
393 static int gpio_fwd_set_multiple(struct gpiochip_fwd *fwd, unsigned long *mask, in gpio_fwd_set_multiple() argument
396 struct gpio_desc **descs = fwd_tmp_descs(fwd); in gpio_fwd_set_multiple()
397 unsigned long *values = fwd_tmp_values(fwd); in gpio_fwd_set_multiple()
398 unsigned int i, j = 0, ret; in gpio_fwd_set_multiple()
400 for_each_set_bit(i, mask, fwd->chip.ngpio) { in gpio_fwd_set_multiple()
402 descs[j++] = fwd->descs[i]; in gpio_fwd_set_multiple()
405 if (fwd->chip.can_sleep) in gpio_fwd_set_multiple()
413 static int gpio_fwd_set_multiple_locked(struct gpio_chip *chip, in gpio_fwd_set_multiple_locked()
414 unsigned long *mask, unsigned long *bits) in gpio_fwd_set_multiple_locked() argument
416 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpio_fwd_set_multiple_locked() local
418 int ret; in gpio_fwd_set_multiple_locked()
420 if (chip->can_sleep) { in gpio_fwd_set_multiple_locked()
421 mutex_lock(&fwd->mlock); in gpio_fwd_set_multiple_locked()
422 ret = gpio_fwd_set_multiple(fwd, mask, bits); in gpio_fwd_set_multiple_locked()
423 mutex_unlock(&fwd->mlock); in gpio_fwd_set_multiple_locked()
425 spin_lock_irqsave(&fwd->slock, flags); in gpio_fwd_set_multiple_locked()
426 ret = gpio_fwd_set_multiple(fwd, mask, bits); in gpio_fwd_set_multiple_locked()
427 spin_unlock_irqrestore(&fwd->slock, flags); in gpio_fwd_set_multiple_locked()
433 static int gpio_fwd_set_config(struct gpio_chip *chip, unsigned int offset, in gpio_fwd_set_config()
436 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpio_fwd_set_config() local
438 return gpiod_set_config(fwd->descs[offset], config); in gpio_fwd_set_config()
441 static int gpio_fwd_to_irq(struct gpio_chip *chip, unsigned int offset) in gpio_fwd_to_irq()
443 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpio_fwd_to_irq() local
445 return gpiod_to_irq(fwd->descs[offset]); in gpio_fwd_to_irq()
450 * for the GPIO ramp-up or ramp-down delays. This can serve the following
452 * - Open-drain output using an RC filter
457 static int gpiochip_fwd_delay_of_xlate(struct gpio_chip *chip, in gpiochip_fwd_delay_of_xlate()
461 struct gpiochip_fwd *fwd = gpiochip_get_data(chip); in gpiochip_fwd_delay_of_xlate() local
465 if (gpiospec->args_count != chip->of_gpio_n_cells) in gpiochip_fwd_delay_of_xlate()
466 return -EINVAL; in gpiochip_fwd_delay_of_xlate()
468 line = gpiospec->args[0]; in gpiochip_fwd_delay_of_xlate()
469 if (line >= chip->ngpio) in gpiochip_fwd_delay_of_xlate()
470 return -EINVAL; in gpiochip_fwd_delay_of_xlate()
472 timings = &fwd->delay_timings[line]; in gpiochip_fwd_delay_of_xlate()
473 timings->ramp_up_us = gpiospec->args[1]; in gpiochip_fwd_delay_of_xlate()
474 timings->ramp_down_us = gpiospec->args[2]; in gpiochip_fwd_delay_of_xlate()
479 static int gpiochip_fwd_setup_delay_line(struct device *dev, struct gpio_chip *chip, in gpiochip_fwd_setup_delay_line()
480 struct gpiochip_fwd *fwd) in gpiochip_fwd_setup_delay_line() argument
482 fwd->delay_timings = devm_kcalloc(dev, chip->ngpio, in gpiochip_fwd_setup_delay_line()
483 sizeof(*fwd->delay_timings), in gpiochip_fwd_setup_delay_line()
485 if (!fwd->delay_timings) in gpiochip_fwd_setup_delay_line()
486 return -ENOMEM; in gpiochip_fwd_setup_delay_line()
488 chip->of_xlate = gpiochip_fwd_delay_of_xlate; in gpiochip_fwd_setup_delay_line()
489 chip->of_gpio_n_cells = 3; in gpiochip_fwd_setup_delay_line()
494 static int gpiochip_fwd_setup_delay_line(struct device *dev, struct gpio_chip *chip, in gpiochip_fwd_setup_delay_line()
495 struct gpiochip_fwd *fwd) in gpiochip_fwd_setup_delay_line() argument
502 * gpiochip_fwd_create() - Create a new GPIO forwarder
513 * Return: An opaque object pointer, or an ERR_PTR()-encoded negative error
517 unsigned int ngpios, in gpiochip_fwd_create()
522 struct gpiochip_fwd *fwd; in gpiochip_fwd_create() local
524 unsigned int i; in gpiochip_fwd_create()
525 int error; in gpiochip_fwd_create()
527 fwd = devm_kzalloc(dev, struct_size(fwd, tmp, fwd_tmp_size(ngpios)), in gpiochip_fwd_create()
529 if (!fwd) in gpiochip_fwd_create()
530 return ERR_PTR(-ENOMEM); in gpiochip_fwd_create()
532 chip = &fwd->chip; in gpiochip_fwd_create()
547 chip->can_sleep = true; in gpiochip_fwd_create()
548 if (parent && parent->set_config) in gpiochip_fwd_create()
549 chip->set_config = gpio_fwd_set_config; in gpiochip_fwd_create()
552 chip->label = label; in gpiochip_fwd_create()
553 chip->parent = dev; in gpiochip_fwd_create()
554 chip->owner = THIS_MODULE; in gpiochip_fwd_create()
555 chip->get_direction = gpio_fwd_get_direction; in gpiochip_fwd_create()
556 chip->direction_input = gpio_fwd_direction_input; in gpiochip_fwd_create()
557 chip->direction_output = gpio_fwd_direction_output; in gpiochip_fwd_create()
558 chip->get = gpio_fwd_get; in gpiochip_fwd_create()
559 chip->get_multiple = gpio_fwd_get_multiple_locked; in gpiochip_fwd_create()
560 chip->set_rv = gpio_fwd_set; in gpiochip_fwd_create()
561 chip->set_multiple_rv = gpio_fwd_set_multiple_locked; in gpiochip_fwd_create()
562 chip->to_irq = gpio_fwd_to_irq; in gpiochip_fwd_create()
563 chip->base = -1; in gpiochip_fwd_create()
564 chip->ngpio = ngpios; in gpiochip_fwd_create()
565 fwd->descs = descs; in gpiochip_fwd_create()
567 if (chip->can_sleep) in gpiochip_fwd_create()
568 mutex_init(&fwd->mlock); in gpiochip_fwd_create()
570 spin_lock_init(&fwd->slock); in gpiochip_fwd_create()
573 error = gpiochip_fwd_setup_delay_line(dev, chip, fwd); in gpiochip_fwd_create()
578 error = devm_gpiochip_add_data(dev, chip, fwd); in gpiochip_fwd_create()
582 return fwd; in gpiochip_fwd_create()
590 static int gpio_aggregator_probe(struct platform_device *pdev) in gpio_aggregator_probe()
592 struct device *dev = &pdev->dev; in gpio_aggregator_probe()
594 struct gpiochip_fwd *fwd; in gpio_aggregator_probe() local
596 int i, n; in gpio_aggregator_probe()
604 return -ENOMEM; in gpio_aggregator_probe()
613 fwd = gpiochip_fwd_create(dev, n, descs, features); in gpio_aggregator_probe()
614 if (IS_ERR(fwd)) in gpio_aggregator_probe()
615 return PTR_ERR(fwd); in gpio_aggregator_probe()
617 platform_set_drvdata(pdev, fwd); in gpio_aggregator_probe()
623 .compatible = "gpio-delay",
627 * Add GPIO-operated devices controlled from userspace below,
643 static int __init gpio_aggregator_init(void) in gpio_aggregator_init()