drivers/gpio/gpio-aggregator.c

1 // SPDX-License-Identifier: GPL-2.0-only
5 // Copyright (C) 2019-2020 Glider bv
7 #define DRV_NAME       "gpio-aggregator"
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()
66 	char *args = skip_spaces(aggr->args);  in aggr_parse()
74 		return -ENOMEM;  in aggr_parse()
108 		pr_err("No GPIOs specified\n");  in aggr_parse()
109 		return -EINVAL;  in aggr_parse()
123 		return -ENOENT;  in new_device_store()
125 	/* kernfs guarantees string termination, so count + 1 is safe */  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()
208 		return -EINVAL;  in delete_device_store()
215 		return -ENOENT;  in delete_device_store()
222 		return -ENOENT;  in delete_device_store()
273 #define fwd_tmp_values(fwd)	&(fwd)->tmp[0]
274 #define fwd_tmp_descs(fwd)	(void *)&(fwd)->tmp[BITS_TO_LONGS((fwd)->chip.ngpio)]
282 	return gpiod_get_direction(fwd->descs[offset]);  in gpio_fwd_get_direction()
289 	return gpiod_direction_input(fwd->descs[offset]);  in gpio_fwd_direction_input()
297 	return gpiod_direction_output(fwd->descs[offset], value);  in gpio_fwd_direction_output()
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()
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()
341 	if (chip->can_sleep) {  in gpio_fwd_get_multiple_locked()
342 		mutex_lock(&fwd->mlock);  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()
348 		spin_unlock_irqrestore(&fwd->slock, flags);  in gpio_fwd_get_multiple_locked()
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()
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()
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()
420 	if (chip->can_sleep) {  in gpio_fwd_set_multiple_locked()
421 		mutex_lock(&fwd->mlock);  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()
427 		spin_unlock_irqrestore(&fwd->slock, flags);  in gpio_fwd_set_multiple_locked()
438 	return gpiod_set_config(fwd->descs[offset], config);  in gpio_fwd_set_config()
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
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()
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()
502  * gpiochip_fwd_create() - Create a new GPIO forwarder
504  * @ngpios: Number of GPIOs in the forwarder.
513  * Return: An opaque object pointer, or an ERR_PTR()-encoded negative error
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()
592 	struct device *dev = &pdev->dev;  in gpio_aggregator_probe()
604 		return -ENOMEM;  in gpio_aggregator_probe()
623 		.compatible = "gpio-delay",
627 	 * Add GPIO-operated devices controlled from userspace below,