1 // SPDX-License-Identifier: GPL-2.0-only
5 // Copyright (C) 2019-2020 Glider bv
7 #define DRV_NAME       "gpio-aggregator"
45 	lookups = krealloc(aggr->lookups, struct_size(lookups, table, *n + 2),  in aggr_add_gpio()
48 		return -ENOMEM;  in aggr_add_gpio()
50 	lookups->table[*n] = GPIO_LOOKUP_IDX(key, hwnum, NULL, *n, 0);  in aggr_add_gpio()
53 	memset(&lookups->table[*n], 0, sizeof(lookups->table[*n]));  in aggr_add_gpio()
55 	aggr->lookups = lookups;  in aggr_add_gpio()
61 	char *args = skip_spaces(aggr->args);  in aggr_parse()
69 		return -ENOMEM;  in aggr_parse()
103 		pr_err("No GPIOs specified\n");  in aggr_parse()
104 		error = -EINVAL;  in aggr_parse()
119 	/* kernfs guarantees string termination, so count + 1 is safe */  in new_device_store()
122 		return -ENOMEM;  in new_device_store()
124 	memcpy(aggr->args, buf, count + 1);  in new_device_store()
126 	aggr->lookups = kzalloc(struct_size(aggr->lookups, table, 1),  in new_device_store()
128 	if (!aggr->lookups) {  in new_device_store()
129 		res = -ENOMEM;  in new_device_store()
142 	aggr->lookups->dev_id = kasprintf(GFP_KERNEL, "%s.%d", DRV_NAME, id);  in new_device_store()
143 	if (!aggr->lookups->dev_id) {  in new_device_store()
144 		res = -ENOMEM;  in new_device_store()
152 	gpiod_add_lookup_table(aggr->lookups);  in new_device_store()
160 	aggr->pdev = pdev;  in new_device_store()
164 	gpiod_remove_lookup_table(aggr->lookups);  in new_device_store()
166 	kfree(aggr->lookups->dev_id);  in new_device_store()
172 	kfree(aggr->lookups);  in new_device_store()
182 	platform_device_unregister(aggr->pdev);  in gpio_aggregator_free()
183 	gpiod_remove_lookup_table(aggr->lookups);  in gpio_aggregator_free()
184 	kfree(aggr->lookups->dev_id);  in gpio_aggregator_free()
185 	kfree(aggr->lookups);  in gpio_aggregator_free()
197 		return -EINVAL;  in delete_device_store()
207 		return -ENOENT;  in delete_device_store()
254 	return gpiod_get_direction(fwd->descs[offset]);  in gpio_fwd_get_direction()
261 	return gpiod_direction_input(fwd->descs[offset]);  in gpio_fwd_direction_input()
269 	return gpiod_direction_output(fwd->descs[offset], value);  in gpio_fwd_direction_output()
276 	return gpiod_get_value(fwd->descs[offset]);  in gpio_fwd_get()
288 	values = &fwd->tmp[0];  in gpio_fwd_get_multiple()
289 	descs = (void *)&fwd->tmp[BITS_TO_LONGS(fwd->chip.ngpio)];  in gpio_fwd_get_multiple()
291 	bitmap_clear(values, 0, fwd->chip.ngpio);  in gpio_fwd_get_multiple()
292 	for_each_set_bit(i, mask, fwd->chip.ngpio)  in gpio_fwd_get_multiple()
293 		descs[j++] = fwd->descs[i];  in gpio_fwd_get_multiple()
300 	for_each_set_bit(i, mask, fwd->chip.ngpio)  in gpio_fwd_get_multiple()
313 	if (chip->can_sleep) {  in gpio_fwd_get_multiple_locked()
314 		mutex_lock(&fwd->mlock);  in gpio_fwd_get_multiple_locked()
316 		mutex_unlock(&fwd->mlock);  in gpio_fwd_get_multiple_locked()
318 		spin_lock_irqsave(&fwd->slock, flags);  in gpio_fwd_get_multiple_locked()
320 		spin_unlock_irqrestore(&fwd->slock, flags);  in gpio_fwd_get_multiple_locked()
330 	gpiod_set_value(fwd->descs[offset], value);  in gpio_fwd_set()
341 	values = &fwd->tmp[0];  in gpio_fwd_set_multiple()
342 	descs = (void *)&fwd->tmp[BITS_TO_LONGS(fwd->chip.ngpio)];  in gpio_fwd_set_multiple()
344 	for_each_set_bit(i, mask, fwd->chip.ngpio) {  in gpio_fwd_set_multiple()
346 		descs[j++] = fwd->descs[i];  in gpio_fwd_set_multiple()
358 	if (chip->can_sleep) {  in gpio_fwd_set_multiple_locked()
359 		mutex_lock(&fwd->mlock);  in gpio_fwd_set_multiple_locked()
361 		mutex_unlock(&fwd->mlock);  in gpio_fwd_set_multiple_locked()
363 		spin_lock_irqsave(&fwd->slock, flags);  in gpio_fwd_set_multiple_locked()
365 		spin_unlock_irqrestore(&fwd->slock, flags);  in gpio_fwd_set_multiple_locked()
374 	return gpiod_set_config(fwd->descs[offset], config);  in gpio_fwd_set_config()
378  * gpiochip_fwd_create() - Create a new GPIO forwarder
380  * @ngpios: Number of GPIOs in the forwarder.
388  * Return: An opaque object pointer, or an ERR_PTR()-encoded negative error
404 		return ERR_PTR(-ENOMEM);  in gpiochip_fwd_create()
406 	chip = &fwd->chip;  in gpiochip_fwd_create()
417 		dev_dbg(dev, "%u => gpio-%d\n", i, desc_to_gpio(descs[i]));  in gpiochip_fwd_create()
420 			chip->can_sleep = true;  in gpiochip_fwd_create()
421 		if (parent && parent->set_config)  in gpiochip_fwd_create()
422 			chip->set_config = gpio_fwd_set_config;  in gpiochip_fwd_create()
425 	chip->label = label;  in gpiochip_fwd_create()
426 	chip->parent = dev;  in gpiochip_fwd_create()
427 	chip->owner = THIS_MODULE;  in gpiochip_fwd_create()
428 	chip->get_direction = gpio_fwd_get_direction;  in gpiochip_fwd_create()
429 	chip->direction_input = gpio_fwd_direction_input;  in gpiochip_fwd_create()
430 	chip->direction_output = gpio_fwd_direction_output;  in gpiochip_fwd_create()
431 	chip->get = gpio_fwd_get;  in gpiochip_fwd_create()
432 	chip->get_multiple = gpio_fwd_get_multiple_locked;  in gpiochip_fwd_create()
433 	chip->set = gpio_fwd_set;  in gpiochip_fwd_create()
434 	chip->set_multiple = gpio_fwd_set_multiple_locked;  in gpiochip_fwd_create()
435 	chip->base = -1;  in gpiochip_fwd_create()
436 	chip->ngpio = ngpios;  in gpiochip_fwd_create()
437 	fwd->descs = descs;  in gpiochip_fwd_create()
439 	if (chip->can_sleep)  in gpiochip_fwd_create()
440 		mutex_init(&fwd->mlock);  in gpiochip_fwd_create()
442 		spin_lock_init(&fwd->slock);  in gpiochip_fwd_create()
458 	struct device *dev = &pdev->dev;  in gpio_aggregator_probe()
469 		return -ENOMEM;  in gpio_aggregator_probe()
488 	 * Add GPIO-operated devices controlled from userspace below,