xref: /linux/drivers/gpio/gpio-virtuser.c (revision 06a130e42a5bfc84795464bff023bff4c16f58c5)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Configurable virtual GPIO consumer module.
4  *
5  * Copyright (C) 2023-2024 Bartosz Golaszewski <bartosz.golaszewski@linaro.org>
6  */
7 
8 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
9 
10 #include <linux/array_size.h>
11 #include <linux/atomic.h>
12 #include <linux/bitmap.h>
13 #include <linux/cleanup.h>
14 #include <linux/completion.h>
15 #include <linux/configfs.h>
16 #include <linux/debugfs.h>
17 #include <linux/device.h>
18 #include <linux/err.h>
19 #include <linux/gpio/consumer.h>
20 #include <linux/gpio/machine.h>
21 #include <linux/idr.h>
22 #include <linux/interrupt.h>
23 #include <linux/irq_work.h>
24 #include <linux/limits.h>
25 #include <linux/list.h>
26 #include <linux/lockdep.h>
27 #include <linux/mod_devicetable.h>
28 #include <linux/module.h>
29 #include <linux/mutex.h>
30 #include <linux/notifier.h>
31 #include <linux/of.h>
32 #include <linux/overflow.h>
33 #include <linux/platform_device.h>
34 #include <linux/printk.h>
35 #include <linux/property.h>
36 #include <linux/slab.h>
37 #include <linux/string_helpers.h>
38 #include <linux/types.h>
39 
40 #define GPIO_VIRTUSER_NAME_BUF_LEN 32
41 
42 static DEFINE_IDA(gpio_virtuser_ida);
43 static struct dentry *gpio_virtuser_dbg_root;
44 
45 struct gpio_virtuser_attr_data {
46 	union {
47 		struct gpio_desc *desc;
48 		struct gpio_descs *descs;
49 	};
50 	struct dentry *dbgfs_dir;
51 };
52 
53 struct gpio_virtuser_line_array_data {
54 	struct gpio_virtuser_attr_data ad;
55 };
56 
57 struct gpio_virtuser_line_data {
58 	struct gpio_virtuser_attr_data ad;
59 	char consumer[GPIO_VIRTUSER_NAME_BUF_LEN];
60 	struct mutex consumer_lock;
61 	unsigned int debounce;
62 	atomic_t irq;
63 	atomic_t irq_count;
64 };
65 
66 struct gpio_virtuser_dbgfs_attr_descr {
67 	const char *name;
68 	const struct file_operations *fops;
69 };
70 
71 struct gpio_virtuser_irq_work_context {
72 	struct irq_work work;
73 	struct completion work_completion;
74 	union {
75 		struct {
76 			struct gpio_desc *desc;
77 			int dir;
78 			int val;
79 			int ret;
80 		};
81 		struct {
82 			struct gpio_descs *descs;
83 			unsigned long *values;
84 		};
85 	};
86 };
87 
88 static struct gpio_virtuser_irq_work_context *
89 to_gpio_virtuser_irq_work_context(struct irq_work *work)
90 {
91 	return container_of(work, struct gpio_virtuser_irq_work_context, work);
92 }
93 
94 static void
95 gpio_virtuser_init_irq_work_context(struct gpio_virtuser_irq_work_context *ctx)
96 {
97 	memset(ctx, 0, sizeof(*ctx));
98 	init_completion(&ctx->work_completion);
99 }
100 
101 static void
102 gpio_virtuser_irq_work_queue_sync(struct gpio_virtuser_irq_work_context *ctx)
103 {
104 	irq_work_queue(&ctx->work);
105 	wait_for_completion(&ctx->work_completion);
106 }
107 
108 static void gpio_virtuser_dbgfs_emit_value_array(char *buf,
109 						 unsigned long *values,
110 						 size_t num_values)
111 {
112 	size_t i;
113 
114 	for (i = 0; i < num_values; i++)
115 		buf[i] = test_bit(i, values) ? '1' : '0';
116 
117 	buf[i++] = '\n';
118 }
119 
120 static void gpio_virtuser_get_value_array_atomic(struct irq_work *work)
121 {
122 	struct gpio_virtuser_irq_work_context *ctx =
123 				to_gpio_virtuser_irq_work_context(work);
124 	struct gpio_descs *descs = ctx->descs;
125 
126 	ctx->ret = gpiod_get_array_value(descs->ndescs, descs->desc,
127 					 descs->info, ctx->values);
128 	complete(&ctx->work_completion);
129 }
130 
131 static int gpio_virtuser_get_array_value(struct gpio_descs *descs,
132 					 unsigned long *values, bool atomic)
133 {
134 	struct gpio_virtuser_irq_work_context ctx;
135 
136 	if (!atomic)
137 		return gpiod_get_array_value_cansleep(descs->ndescs,
138 						      descs->desc,
139 						      descs->info, values);
140 
141 	gpio_virtuser_init_irq_work_context(&ctx);
142 	ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_get_value_array_atomic);
143 	ctx.descs = descs;
144 	ctx.values = values;
145 
146 	gpio_virtuser_irq_work_queue_sync(&ctx);
147 
148 	return ctx.ret;
149 }
150 
151 static ssize_t gpio_virtuser_value_array_do_read(struct file *file,
152 						 char __user *user_buf,
153 						 size_t size, loff_t *ppos,
154 						 bool atomic)
155 {
156 	struct gpio_virtuser_line_data *data = file->private_data;
157 	struct gpio_descs *descs = data->ad.descs;
158 	size_t bufsize;
159 	int ret;
160 
161 	unsigned long *values __free(bitmap) = bitmap_zalloc(descs->ndescs,
162 							     GFP_KERNEL);
163 	if (!values)
164 		return -ENOMEM;
165 
166 	ret = gpio_virtuser_get_array_value(descs, values, atomic);
167 	if (ret)
168 		return ret;
169 
170 	bufsize = descs->ndescs + 2;
171 
172 	char *buf __free(kfree) = kzalloc(bufsize, GFP_KERNEL);
173 	if (!buf)
174 		return -ENOMEM;
175 
176 	gpio_virtuser_dbgfs_emit_value_array(buf, values, descs->ndescs);
177 
178 	return simple_read_from_buffer(user_buf, size, ppos, buf,
179 				       descs->ndescs + 1);
180 }
181 
182 static int gpio_virtuser_dbgfs_parse_value_array(const char *buf,
183 						 size_t len,
184 						 unsigned long *values)
185 {
186 	size_t i;
187 
188 	for (i = 0; i < len; i++) {
189 		if (buf[i] == '0')
190 			clear_bit(i, values);
191 		else if (buf[i] == '1')
192 			set_bit(i, values);
193 		else
194 			return -EINVAL;
195 	}
196 
197 	return 0;
198 }
199 
200 static void gpio_virtuser_set_value_array_atomic(struct irq_work *work)
201 {
202 	struct gpio_virtuser_irq_work_context *ctx =
203 				to_gpio_virtuser_irq_work_context(work);
204 	struct gpio_descs *descs = ctx->descs;
205 
206 	ctx->ret = gpiod_set_array_value(descs->ndescs, descs->desc,
207 					 descs->info, ctx->values);
208 	complete(&ctx->work_completion);
209 }
210 
211 static int gpio_virtuser_set_array_value(struct gpio_descs *descs,
212 					 unsigned long *values, bool atomic)
213 {
214 	struct gpio_virtuser_irq_work_context ctx;
215 
216 	if (!atomic)
217 		return gpiod_set_array_value_cansleep(descs->ndescs,
218 						      descs->desc,
219 						      descs->info, values);
220 
221 	gpio_virtuser_init_irq_work_context(&ctx);
222 	ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_set_value_array_atomic);
223 	ctx.descs = descs;
224 	ctx.values = values;
225 
226 	gpio_virtuser_irq_work_queue_sync(&ctx);
227 
228 	return ctx.ret;
229 }
230 
231 static ssize_t gpio_virtuser_value_array_do_write(struct file *file,
232 						  const char __user *user_buf,
233 						  size_t count, loff_t *ppos,
234 						  bool atomic)
235 {
236 	struct gpio_virtuser_line_data *data = file->private_data;
237 	struct gpio_descs *descs = data->ad.descs;
238 	int ret;
239 
240 	if (count - 1 != descs->ndescs)
241 		return -EINVAL;
242 
243 	char *buf __free(kfree) = kzalloc(count, GFP_KERNEL);
244 	if (!buf)
245 		return -ENOMEM;
246 
247 	ret = simple_write_to_buffer(buf, count, ppos, user_buf, count);
248 	if (ret < 0)
249 		return ret;
250 
251 	unsigned long *values __free(bitmap) = bitmap_zalloc(descs->ndescs,
252 							     GFP_KERNEL);
253 	if (!values)
254 		return -ENOMEM;
255 
256 	ret = gpio_virtuser_dbgfs_parse_value_array(buf, count - 1, values);
257 	if (ret)
258 		return ret;
259 
260 	ret = gpio_virtuser_set_array_value(descs, values, atomic);
261 	if (ret)
262 		return ret;
263 
264 	return count;
265 }
266 
267 static ssize_t gpio_virtuser_value_array_read(struct file *file,
268 					      char __user *user_buf,
269 					      size_t count, loff_t *ppos)
270 {
271 	return gpio_virtuser_value_array_do_read(file, user_buf, count, ppos,
272 						 false);
273 }
274 
275 static ssize_t gpio_virtuser_value_array_write(struct file *file,
276 					       const char __user *user_buf,
277 					       size_t count, loff_t *ppos)
278 {
279 	return gpio_virtuser_value_array_do_write(file, user_buf, count, ppos,
280 						  false);
281 }
282 
283 static const struct file_operations gpio_virtuser_value_array_fops = {
284 	.read = gpio_virtuser_value_array_read,
285 	.write = gpio_virtuser_value_array_write,
286 	.open = simple_open,
287 	.owner = THIS_MODULE,
288 	.llseek = default_llseek,
289 };
290 
291 static ssize_t
292 gpio_virtuser_value_array_atomic_read(struct file *file, char __user *user_buf,
293 				      size_t count, loff_t *ppos)
294 {
295 	return gpio_virtuser_value_array_do_read(file, user_buf, count, ppos,
296 						 true);
297 }
298 
299 static ssize_t
300 gpio_virtuser_value_array_atomic_write(struct file *file,
301 				       const char __user *user_buf,
302 				       size_t count, loff_t *ppos)
303 {
304 	return gpio_virtuser_value_array_do_write(file, user_buf, count, ppos,
305 						  true);
306 }
307 
308 static const struct file_operations gpio_virtuser_value_array_atomic_fops = {
309 	.read = gpio_virtuser_value_array_atomic_read,
310 	.write = gpio_virtuser_value_array_atomic_write,
311 	.open = simple_open,
312 	.owner = THIS_MODULE,
313 	.llseek = default_llseek,
314 };
315 
316 static void gpio_virtuser_do_get_direction_atomic(struct irq_work *work)
317 {
318 	struct gpio_virtuser_irq_work_context *ctx =
319 				to_gpio_virtuser_irq_work_context(work);
320 
321 	ctx->ret = gpiod_get_direction(ctx->desc);
322 	complete(&ctx->work_completion);
323 }
324 
325 static int gpio_virtuser_get_direction_atomic(struct gpio_desc *desc)
326 {
327 	struct gpio_virtuser_irq_work_context ctx;
328 
329 	gpio_virtuser_init_irq_work_context(&ctx);
330 	ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_do_get_direction_atomic);
331 	ctx.desc = desc;
332 
333 	gpio_virtuser_irq_work_queue_sync(&ctx);
334 
335 	return ctx.ret;
336 }
337 
338 static ssize_t gpio_virtuser_direction_do_read(struct file *file,
339 					       char __user *user_buf,
340 					       size_t size, loff_t *ppos,
341 					       bool atomic)
342 {
343 	struct gpio_virtuser_line_data *data = file->private_data;
344 	struct gpio_desc *desc = data->ad.desc;
345 	char buf[32];
346 	int dir;
347 
348 	if (!atomic)
349 		dir = gpiod_get_direction(desc);
350 	else
351 		dir = gpio_virtuser_get_direction_atomic(desc);
352 	if (dir < 0)
353 		return dir;
354 
355 	snprintf(buf, sizeof(buf), "%s\n", dir ? "input" : "output");
356 
357 	return simple_read_from_buffer(user_buf, size, ppos, buf, strlen(buf));
358 }
359 
360 static int gpio_virtuser_set_direction(struct gpio_desc *desc, int dir, int val)
361 {
362 	if (dir)
363 		return gpiod_direction_input(desc);
364 
365 	return gpiod_direction_output(desc, val);
366 }
367 
368 static void gpio_virtuser_do_set_direction_atomic(struct irq_work *work)
369 {
370 	struct gpio_virtuser_irq_work_context *ctx =
371 				to_gpio_virtuser_irq_work_context(work);
372 
373 	ctx->ret = gpio_virtuser_set_direction(ctx->desc, ctx->dir, ctx->val);
374 	complete(&ctx->work_completion);
375 }
376 
377 static int gpio_virtuser_set_direction_atomic(struct gpio_desc *desc,
378 					      int dir, int val)
379 {
380 	struct gpio_virtuser_irq_work_context ctx;
381 
382 	gpio_virtuser_init_irq_work_context(&ctx);
383 	ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_do_set_direction_atomic);
384 	ctx.desc = desc;
385 	ctx.dir = dir;
386 	ctx.val = val;
387 
388 	gpio_virtuser_irq_work_queue_sync(&ctx);
389 
390 	return ctx.ret;
391 }
392 
393 static ssize_t gpio_virtuser_direction_do_write(struct file *file,
394 						const char __user *user_buf,
395 						size_t count, loff_t *ppos,
396 						bool atomic)
397 {
398 	struct gpio_virtuser_line_data *data = file->private_data;
399 	struct gpio_desc *desc = data->ad.desc;
400 	char buf[32], *trimmed;
401 	int ret, dir, val = 0;
402 
403 	ret = simple_write_to_buffer(buf, sizeof(buf), ppos, user_buf, count);
404 	if (ret < 0)
405 		return ret;
406 
407 	trimmed = strim(buf);
408 
409 	if (strcmp(trimmed, "input") == 0) {
410 		dir = 1;
411 	} else if (strcmp(trimmed, "output-high") == 0) {
412 		dir = 0;
413 		val = 1;
414 	} else if (strcmp(trimmed, "output-low") == 0) {
415 		dir = val = 0;
416 	} else {
417 		return -EINVAL;
418 	}
419 
420 	if (!atomic)
421 		ret = gpio_virtuser_set_direction(desc, dir, val);
422 	else
423 		ret = gpio_virtuser_set_direction_atomic(desc, dir, val);
424 	if (ret)
425 		return ret;
426 
427 	return count;
428 }
429 
430 static ssize_t gpio_virtuser_direction_read(struct file *file,
431 					    char __user *user_buf,
432 					    size_t size, loff_t *ppos)
433 {
434 	return gpio_virtuser_direction_do_read(file, user_buf, size, ppos,
435 					       false);
436 }
437 
438 static ssize_t gpio_virtuser_direction_write(struct file *file,
439 					     const char __user *user_buf,
440 					     size_t count, loff_t *ppos)
441 {
442 	return gpio_virtuser_direction_do_write(file, user_buf, count, ppos,
443 						false);
444 }
445 
446 static const struct file_operations gpio_virtuser_direction_fops = {
447 	.read = gpio_virtuser_direction_read,
448 	.write = gpio_virtuser_direction_write,
449 	.open = simple_open,
450 	.owner = THIS_MODULE,
451 	.llseek = default_llseek,
452 };
453 
454 static ssize_t gpio_virtuser_direction_atomic_read(struct file *file,
455 						   char __user *user_buf,
456 						   size_t size, loff_t *ppos)
457 {
458 	return gpio_virtuser_direction_do_read(file, user_buf, size, ppos,
459 					       true);
460 }
461 
462 static ssize_t gpio_virtuser_direction_atomic_write(struct file *file,
463 						    const char __user *user_buf,
464 						    size_t count, loff_t *ppos)
465 {
466 	return gpio_virtuser_direction_do_write(file, user_buf, count, ppos,
467 						true);
468 }
469 
470 static const struct file_operations gpio_virtuser_direction_atomic_fops = {
471 	.read = gpio_virtuser_direction_atomic_read,
472 	.write = gpio_virtuser_direction_atomic_write,
473 	.open = simple_open,
474 	.owner = THIS_MODULE,
475 	.llseek = default_llseek,
476 };
477 
478 static int gpio_virtuser_value_get(void *data, u64 *val)
479 {
480 	struct gpio_virtuser_line_data *ld = data;
481 	int ret;
482 
483 	ret = gpiod_get_value_cansleep(ld->ad.desc);
484 	if (ret < 0)
485 		return ret;
486 
487 	*val = ret;
488 
489 	return 0;
490 }
491 
492 static int gpio_virtuser_value_set(void *data, u64 val)
493 {
494 	struct gpio_virtuser_line_data *ld = data;
495 
496 	if (val > 1)
497 		return -EINVAL;
498 
499 	gpiod_set_value_cansleep(ld->ad.desc, (int)val);
500 
501 	return 0;
502 }
503 
504 DEFINE_DEBUGFS_ATTRIBUTE(gpio_virtuser_value_fops,
505 			 gpio_virtuser_value_get,
506 			 gpio_virtuser_value_set,
507 			 "%llu\n");
508 
509 static void gpio_virtuser_get_value_atomic(struct irq_work *work)
510 {
511 	struct gpio_virtuser_irq_work_context *ctx =
512 				to_gpio_virtuser_irq_work_context(work);
513 
514 	ctx->val = gpiod_get_value(ctx->desc);
515 	complete(&ctx->work_completion);
516 }
517 
518 static int gpio_virtuser_value_atomic_get(void *data, u64 *val)
519 {
520 	struct gpio_virtuser_line_data *ld = data;
521 	struct gpio_virtuser_irq_work_context ctx;
522 
523 	gpio_virtuser_init_irq_work_context(&ctx);
524 	ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_get_value_atomic);
525 	ctx.desc = ld->ad.desc;
526 
527 	gpio_virtuser_irq_work_queue_sync(&ctx);
528 
529 	if (ctx.val < 0)
530 		return ctx.val;
531 
532 	*val = ctx.val;
533 
534 	return 0;
535 }
536 
537 static void gpio_virtuser_set_value_atomic(struct irq_work *work)
538 {
539 	struct gpio_virtuser_irq_work_context *ctx =
540 			to_gpio_virtuser_irq_work_context(work);
541 
542 	gpiod_set_value(ctx->desc, ctx->val);
543 	complete(&ctx->work_completion);
544 }
545 
546 static int gpio_virtuser_value_atomic_set(void *data, u64 val)
547 {
548 	struct gpio_virtuser_line_data *ld = data;
549 	struct gpio_virtuser_irq_work_context ctx;
550 
551 	if (val > 1)
552 		return -EINVAL;
553 
554 	gpio_virtuser_init_irq_work_context(&ctx);
555 	ctx.work = IRQ_WORK_INIT_HARD(gpio_virtuser_set_value_atomic);
556 	ctx.desc = ld->ad.desc;
557 	ctx.val = (int)val;
558 
559 	gpio_virtuser_irq_work_queue_sync(&ctx);
560 
561 	return 0;
562 }
563 
564 DEFINE_DEBUGFS_ATTRIBUTE(gpio_virtuser_value_atomic_fops,
565 			 gpio_virtuser_value_atomic_get,
566 			 gpio_virtuser_value_atomic_set,
567 			 "%llu\n");
568 
569 static int gpio_virtuser_debounce_get(void *data, u64 *val)
570 {
571 	struct gpio_virtuser_line_data *ld = data;
572 
573 	*val = READ_ONCE(ld->debounce);
574 
575 	return 0;
576 }
577 
578 static int gpio_virtuser_debounce_set(void *data, u64 val)
579 {
580 	struct gpio_virtuser_line_data *ld = data;
581 	int ret;
582 
583 	if (val > UINT_MAX)
584 		return -E2BIG;
585 
586 	ret = gpiod_set_debounce(ld->ad.desc, (unsigned int)val);
587 	if (ret)
588 		/* Don't propagate errno unknown to user-space. */
589 		return ret == -ENOTSUPP ? -EOPNOTSUPP : ret;
590 
591 	WRITE_ONCE(ld->debounce, (unsigned int)val);
592 
593 	return 0;
594 }
595 
596 DEFINE_DEBUGFS_ATTRIBUTE(gpio_virtuser_debounce_fops,
597 			 gpio_virtuser_debounce_get,
598 			 gpio_virtuser_debounce_set,
599 			 "%llu\n");
600 
601 static ssize_t gpio_virtuser_consumer_read(struct file *file,
602 					   char __user *user_buf,
603 					   size_t size, loff_t *ppos)
604 {
605 	struct gpio_virtuser_line_data *data = file->private_data;
606 	char buf[GPIO_VIRTUSER_NAME_BUF_LEN + 1];
607 	ssize_t ret;
608 
609 	memset(buf, 0x0, sizeof(buf));
610 
611 	scoped_guard(mutex, &data->consumer_lock)
612 		ret = snprintf(buf, sizeof(buf), "%s\n", data->consumer);
613 
614 	return simple_read_from_buffer(user_buf, size, ppos, buf, ret);
615 }
616 
617 static ssize_t gpio_virtuser_consumer_write(struct file *file,
618 					    const char __user *user_buf,
619 					    size_t count, loff_t *ppos)
620 {
621 	struct gpio_virtuser_line_data *data = file->private_data;
622 	char buf[GPIO_VIRTUSER_NAME_BUF_LEN + 2];
623 	int ret;
624 
625 	ret = simple_write_to_buffer(buf, GPIO_VIRTUSER_NAME_BUF_LEN, ppos,
626 				     user_buf, count);
627 	if (ret < 0)
628 		return ret;
629 
630 	buf[strlen(buf) - 1] = '\0';
631 
632 	ret = gpiod_set_consumer_name(data->ad.desc, buf);
633 	if (ret)
634 		return ret;
635 
636 	scoped_guard(mutex, &data->consumer_lock)
637 		strscpy(data->consumer, buf, sizeof(data->consumer));
638 
639 	return count;
640 }
641 
642 static const struct file_operations gpio_virtuser_consumer_fops = {
643 	.read = gpio_virtuser_consumer_read,
644 	.write = gpio_virtuser_consumer_write,
645 	.open = simple_open,
646 	.owner = THIS_MODULE,
647 	.llseek = default_llseek,
648 };
649 
650 static int gpio_virtuser_interrupts_get(void *data, u64 *val)
651 {
652 	struct gpio_virtuser_line_data *ld = data;
653 
654 	*val = atomic_read(&ld->irq_count);
655 
656 	return 0;
657 }
658 
659 static irqreturn_t gpio_virtuser_irq_handler(int irq, void *data)
660 {
661 	struct gpio_virtuser_line_data *ld = data;
662 
663 	atomic_inc(&ld->irq_count);
664 
665 	return IRQ_HANDLED;
666 }
667 
668 static int gpio_virtuser_interrupts_set(void *data, u64 val)
669 {
670 	struct gpio_virtuser_line_data *ld = data;
671 	int irq, ret;
672 
673 	if (val > 1)
674 		return -EINVAL;
675 
676 	if (val) {
677 		irq = gpiod_to_irq(ld->ad.desc);
678 		if (irq < 0)
679 			return irq;
680 
681 		ret = request_threaded_irq(irq, NULL,
682 					   gpio_virtuser_irq_handler,
683 					   IRQF_TRIGGER_RISING |
684 					   IRQF_TRIGGER_FALLING |
685 					   IRQF_ONESHOT,
686 					   ld->consumer, data);
687 		if (ret)
688 			return ret;
689 
690 		atomic_set(&ld->irq, irq);
691 	} else {
692 		irq = atomic_xchg(&ld->irq, 0);
693 		free_irq(irq, ld);
694 	}
695 
696 	return 0;
697 }
698 
699 DEFINE_DEBUGFS_ATTRIBUTE(gpio_virtuser_interrupts_fops,
700 			 gpio_virtuser_interrupts_get,
701 			 gpio_virtuser_interrupts_set,
702 			 "%llu\n");
703 
704 static const struct gpio_virtuser_dbgfs_attr_descr
705 gpio_virtuser_line_array_dbgfs_attrs[] = {
706 	{
707 		.name = "values",
708 		.fops = &gpio_virtuser_value_array_fops,
709 	},
710 	{
711 		.name = "values_atomic",
712 		.fops = &gpio_virtuser_value_array_atomic_fops,
713 	},
714 };
715 
716 static const struct gpio_virtuser_dbgfs_attr_descr
717 gpio_virtuser_line_dbgfs_attrs[] = {
718 	{
719 		.name = "direction",
720 		.fops = &gpio_virtuser_direction_fops,
721 	},
722 	{
723 		.name = "direction_atomic",
724 		.fops = &gpio_virtuser_direction_atomic_fops,
725 	},
726 	{
727 		.name = "value",
728 		.fops = &gpio_virtuser_value_fops,
729 	},
730 	{
731 		.name = "value_atomic",
732 		.fops = &gpio_virtuser_value_atomic_fops,
733 	},
734 	{
735 		.name = "debounce",
736 		.fops = &gpio_virtuser_debounce_fops,
737 	},
738 	{
739 		.name = "consumer",
740 		.fops = &gpio_virtuser_consumer_fops,
741 	},
742 	{
743 		.name = "interrupts",
744 		.fops = &gpio_virtuser_interrupts_fops,
745 	},
746 };
747 
748 static int gpio_virtuser_create_debugfs_attrs(
749 			const struct gpio_virtuser_dbgfs_attr_descr *attr,
750 			size_t num_attrs, struct dentry *parent, void *data)
751 {
752 	struct dentry *ret;
753 	size_t i;
754 
755 	for (i = 0; i < num_attrs; i++, attr++) {
756 		ret = debugfs_create_file(attr->name, 0644, parent, data,
757 					  attr->fops);
758 		if (IS_ERR(ret))
759 			return PTR_ERR(ret);
760 	}
761 
762 	return 0;
763 }
764 
765 static int gpio_virtuser_dbgfs_init_line_array_attrs(struct device *dev,
766 						     struct gpio_descs *descs,
767 						     const char *id,
768 						     struct dentry *dbgfs_entry)
769 {
770 	struct gpio_virtuser_line_array_data *data;
771 	char *name;
772 
773 	data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
774 	if (!data)
775 		return -ENOMEM;
776 
777 	data->ad.descs = descs;
778 
779 	name = devm_kasprintf(dev, GFP_KERNEL, "gpiod:%s", id);
780 	if (!name)
781 		return -ENOMEM;
782 
783 	data->ad.dbgfs_dir = debugfs_create_dir(name, dbgfs_entry);
784 	if (IS_ERR(data->ad.dbgfs_dir))
785 		return PTR_ERR(data->ad.dbgfs_dir);
786 
787 	return gpio_virtuser_create_debugfs_attrs(
788 			gpio_virtuser_line_array_dbgfs_attrs,
789 			ARRAY_SIZE(gpio_virtuser_line_array_dbgfs_attrs),
790 			data->ad.dbgfs_dir, data);
791 }
792 
793 static int gpio_virtuser_dbgfs_init_line_attrs(struct device *dev,
794 					       struct gpio_desc *desc,
795 					       const char *id,
796 					       unsigned int index,
797 					       struct dentry *dbgfs_entry)
798 {
799 	struct gpio_virtuser_line_data *data;
800 	char *name;
801 	int ret;
802 
803 	data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
804 	if (!data)
805 		return -ENOMEM;
806 
807 	data->ad.desc = desc;
808 	strscpy(data->consumer, id);
809 	atomic_set(&data->irq, 0);
810 	atomic_set(&data->irq_count, 0);
811 
812 	name = devm_kasprintf(dev, GFP_KERNEL, "gpiod:%s:%u", id, index);
813 	if (!name)
814 		return -ENOMEM;
815 
816 	ret = devm_mutex_init(dev, &data->consumer_lock);
817 	if (ret)
818 		return ret;
819 
820 	data->ad.dbgfs_dir = debugfs_create_dir(name, dbgfs_entry);
821 	if (IS_ERR(data->ad.dbgfs_dir))
822 		return PTR_ERR(data->ad.dbgfs_dir);
823 
824 	return gpio_virtuser_create_debugfs_attrs(
825 				gpio_virtuser_line_dbgfs_attrs,
826 				ARRAY_SIZE(gpio_virtuser_line_dbgfs_attrs),
827 				data->ad.dbgfs_dir, data);
828 }
829 
830 static void gpio_virtuser_debugfs_remove(void *data)
831 {
832 	struct dentry *dbgfs_entry = data;
833 
834 	debugfs_remove_recursive(dbgfs_entry);
835 }
836 
837 static int gpio_virtuser_prop_is_gpio(struct property *prop)
838 {
839 	char *dash = strrchr(prop->name, '-');
840 
841 	return dash && strcmp(dash, "-gpios") == 0;
842 }
843 
844 /*
845  * If this is an OF-based system, then we iterate over properties and consider
846  * all whose names end in "-gpios". For configfs we expect an additional string
847  * array property - "gpio-virtuser,ids" - containing the list of all GPIO IDs
848  * to request.
849  */
850 static int gpio_virtuser_count_ids(struct device *dev)
851 {
852 	struct device_node *of_node = dev_of_node(dev);
853 	struct property *prop;
854 	int ret = 0;
855 
856 	if (!of_node)
857 		return device_property_string_array_count(dev,
858 							  "gpio-virtuser,ids");
859 
860 	for_each_property_of_node(of_node, prop) {
861 		if (gpio_virtuser_prop_is_gpio(prop))
862 			++ret;
863 	}
864 
865 	return ret;
866 }
867 
868 static int gpio_virtuser_get_ids(struct device *dev, const char **ids,
869 				 int num_ids)
870 {
871 	struct device_node *of_node = dev_of_node(dev);
872 	struct property *prop;
873 	size_t pos = 0, diff;
874 	char *dash, *tmp;
875 
876 	if (!of_node)
877 		return device_property_read_string_array(dev,
878 							 "gpio-virtuser,ids",
879 							 ids, num_ids);
880 
881 	for_each_property_of_node(of_node, prop) {
882 		if (!gpio_virtuser_prop_is_gpio(prop))
883 			continue;
884 
885 		dash = strrchr(prop->name, '-');
886 		diff = dash - prop->name;
887 
888 		tmp = devm_kmemdup(dev, prop->name, diff + 1,
889 				   GFP_KERNEL);
890 		if (!tmp)
891 			return -ENOMEM;
892 
893 		tmp[diff] = '\0';
894 		ids[pos++] = tmp;
895 	}
896 
897 	return 0;
898 }
899 
900 static int gpio_virtuser_probe(struct platform_device *pdev)
901 {
902 	struct device *dev = &pdev->dev;
903 	struct dentry *dbgfs_entry;
904 	struct gpio_descs *descs;
905 	int ret, num_ids = 0, i;
906 	const char **ids;
907 	unsigned int j;
908 
909 	num_ids = gpio_virtuser_count_ids(dev);
910 	if (num_ids < 0)
911 		return dev_err_probe(dev, num_ids,
912 				     "Failed to get the number of GPIOs to request\n");
913 
914 	if (num_ids == 0)
915 		return dev_err_probe(dev, -EINVAL, "No GPIO IDs specified\n");
916 
917 	ids = devm_kcalloc(dev, num_ids, sizeof(*ids), GFP_KERNEL);
918 	if (!ids)
919 		return -ENOMEM;
920 
921 	ret = gpio_virtuser_get_ids(dev, ids, num_ids);
922 	if (ret < 0)
923 		return dev_err_probe(dev, ret,
924 				     "Failed to get the IDs of GPIOs to request\n");
925 
926 	dbgfs_entry = debugfs_create_dir(dev_name(dev), gpio_virtuser_dbg_root);
927 	ret = devm_add_action_or_reset(dev, gpio_virtuser_debugfs_remove,
928 				       dbgfs_entry);
929 	if (ret)
930 		return ret;
931 
932 	for (i = 0; i < num_ids; i++) {
933 		descs = devm_gpiod_get_array(dev, ids[i], GPIOD_ASIS);
934 		if (IS_ERR(descs))
935 			return dev_err_probe(dev, PTR_ERR(descs),
936 					     "Failed to request the '%s' GPIOs\n",
937 					     ids[i]);
938 
939 		ret = gpio_virtuser_dbgfs_init_line_array_attrs(dev, descs,
940 								ids[i],
941 								dbgfs_entry);
942 		if (ret)
943 			return dev_err_probe(dev, ret,
944 					     "Failed to setup the debugfs array interface for the '%s' GPIOs\n",
945 					     ids[i]);
946 
947 		for (j = 0; j < descs->ndescs; j++) {
948 			ret = gpio_virtuser_dbgfs_init_line_attrs(dev,
949 							descs->desc[j], ids[i],
950 							j, dbgfs_entry);
951 			if (ret)
952 				return dev_err_probe(dev, ret,
953 						     "Failed to setup the debugfs line interface for the '%s' GPIOs\n",
954 						     ids[i]);
955 		}
956 	}
957 
958 	return 0;
959 }
960 
961 static const struct of_device_id gpio_virtuser_of_match[] = {
962 	{ .compatible = "gpio-virtuser" },
963 	{ }
964 };
965 MODULE_DEVICE_TABLE(of, gpio_virtuser_of_match);
966 
967 static struct platform_driver gpio_virtuser_driver = {
968 	.driver = {
969 		.name = "gpio-virtuser",
970 		.of_match_table = gpio_virtuser_of_match,
971 	},
972 	.probe = gpio_virtuser_probe,
973 };
974 
975 struct gpio_virtuser_device {
976 	struct config_group group;
977 
978 	struct platform_device *pdev;
979 	int id;
980 	struct mutex lock;
981 
982 	struct notifier_block bus_notifier;
983 	struct completion probe_completion;
984 	bool driver_bound;
985 
986 	struct gpiod_lookup_table *lookup_table;
987 
988 	struct list_head lookup_list;
989 };
990 
991 static int gpio_virtuser_bus_notifier_call(struct notifier_block *nb,
992 					   unsigned long action, void *data)
993 {
994 	struct gpio_virtuser_device *vdev;
995 	struct device *dev = data;
996 	char devname[32];
997 
998 	vdev = container_of(nb, struct gpio_virtuser_device, bus_notifier);
999 	snprintf(devname, sizeof(devname), "gpio-virtuser.%d", vdev->id);
1000 
1001 	if (!device_match_name(dev, devname))
1002 		return NOTIFY_DONE;
1003 
1004 	switch (action) {
1005 	case BUS_NOTIFY_BOUND_DRIVER:
1006 		vdev->driver_bound = true;
1007 		break;
1008 	case BUS_NOTIFY_DRIVER_NOT_BOUND:
1009 		vdev->driver_bound = false;
1010 		break;
1011 	default:
1012 		return NOTIFY_DONE;
1013 	}
1014 
1015 	complete(&vdev->probe_completion);
1016 	return NOTIFY_OK;
1017 }
1018 
1019 static struct gpio_virtuser_device *
1020 to_gpio_virtuser_device(struct config_item *item)
1021 {
1022 	struct config_group *group = to_config_group(item);
1023 
1024 	return container_of(group, struct gpio_virtuser_device, group);
1025 }
1026 
1027 static bool
1028 gpio_virtuser_device_is_live(struct gpio_virtuser_device *dev)
1029 {
1030 	lockdep_assert_held(&dev->lock);
1031 
1032 	return !!dev->pdev;
1033 }
1034 
1035 struct gpio_virtuser_lookup {
1036 	struct config_group group;
1037 
1038 	struct gpio_virtuser_device *parent;
1039 	struct list_head siblings;
1040 
1041 	char *con_id;
1042 
1043 	struct list_head entry_list;
1044 };
1045 
1046 static struct gpio_virtuser_lookup *
1047 to_gpio_virtuser_lookup(struct config_item *item)
1048 {
1049 	struct config_group *group = to_config_group(item);
1050 
1051 	return container_of(group, struct gpio_virtuser_lookup, group);
1052 }
1053 
1054 struct gpio_virtuser_lookup_entry {
1055 	struct config_group group;
1056 
1057 	struct gpio_virtuser_lookup *parent;
1058 	struct list_head siblings;
1059 
1060 	char *key;
1061 	/* Can be negative to indicate lookup by name. */
1062 	int offset;
1063 	enum gpio_lookup_flags flags;
1064 };
1065 
1066 static struct gpio_virtuser_lookup_entry *
1067 to_gpio_virtuser_lookup_entry(struct config_item *item)
1068 {
1069 	struct config_group *group = to_config_group(item);
1070 
1071 	return container_of(group, struct gpio_virtuser_lookup_entry, group);
1072 }
1073 
1074 static ssize_t
1075 gpio_virtuser_lookup_entry_config_key_show(struct config_item *item, char *page)
1076 {
1077 	struct gpio_virtuser_lookup_entry *entry =
1078 					to_gpio_virtuser_lookup_entry(item);
1079 	struct gpio_virtuser_device *dev = entry->parent->parent;
1080 
1081 	guard(mutex)(&dev->lock);
1082 
1083 	return sprintf(page, "%s\n", entry->key ?: "");
1084 }
1085 
1086 static ssize_t
1087 gpio_virtuser_lookup_entry_config_key_store(struct config_item *item,
1088 					    const char *page, size_t count)
1089 {
1090 	struct gpio_virtuser_lookup_entry *entry =
1091 					to_gpio_virtuser_lookup_entry(item);
1092 	struct gpio_virtuser_device *dev = entry->parent->parent;
1093 
1094 	char *key __free(kfree) = kstrndup(skip_spaces(page), count,
1095 					   GFP_KERNEL);
1096 	if (!key)
1097 		return -ENOMEM;
1098 
1099 	strim(key);
1100 
1101 	guard(mutex)(&dev->lock);
1102 
1103 	if (gpio_virtuser_device_is_live(dev))
1104 		return -EBUSY;
1105 
1106 	kfree(entry->key);
1107 	entry->key = no_free_ptr(key);
1108 
1109 	return count;
1110 }
1111 
1112 CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, key);
1113 
1114 static ssize_t
1115 gpio_virtuser_lookup_entry_config_offset_show(struct config_item *item,
1116 					      char *page)
1117 {
1118 	struct gpio_virtuser_lookup_entry *entry =
1119 					to_gpio_virtuser_lookup_entry(item);
1120 	struct gpio_virtuser_device *dev = entry->parent->parent;
1121 	unsigned int offset;
1122 
1123 	scoped_guard(mutex, &dev->lock)
1124 		offset = entry->offset;
1125 
1126 	return sprintf(page, "%d\n", offset);
1127 }
1128 
1129 static ssize_t
1130 gpio_virtuser_lookup_entry_config_offset_store(struct config_item *item,
1131 					       const char *page, size_t count)
1132 {
1133 	struct gpio_virtuser_lookup_entry *entry =
1134 					to_gpio_virtuser_lookup_entry(item);
1135 	struct gpio_virtuser_device *dev = entry->parent->parent;
1136 	int offset, ret;
1137 
1138 	ret = kstrtoint(page, 0, &offset);
1139 	if (ret)
1140 		return ret;
1141 
1142 	/*
1143 	 * Negative number here means: 'key' represents a line name to lookup.
1144 	 * Non-negative means: 'key' represents the label of the chip with
1145 	 * the 'offset' value representing the line within that chip.
1146 	 *
1147 	 * GPIOLIB uses the U16_MAX value to indicate lookup by line name so
1148 	 * the greatest offset we can accept is (U16_MAX - 1).
1149 	 */
1150 	if (offset > (U16_MAX - 1))
1151 		return -EINVAL;
1152 
1153 	guard(mutex)(&dev->lock);
1154 
1155 	if (gpio_virtuser_device_is_live(dev))
1156 		return -EBUSY;
1157 
1158 	entry->offset = offset;
1159 
1160 	return count;
1161 }
1162 
1163 CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, offset);
1164 
1165 static enum gpio_lookup_flags
1166 gpio_virtuser_lookup_get_flags(struct config_item *item)
1167 {
1168 	struct gpio_virtuser_lookup_entry *entry =
1169 					to_gpio_virtuser_lookup_entry(item);
1170 	struct gpio_virtuser_device *dev = entry->parent->parent;
1171 
1172 	guard(mutex)(&dev->lock);
1173 
1174 	return entry->flags;
1175 }
1176 
1177 static ssize_t
1178 gpio_virtuser_lookup_entry_config_drive_show(struct config_item *item, char *page)
1179 {
1180 	enum gpio_lookup_flags flags = gpio_virtuser_lookup_get_flags(item);
1181 	const char *repr;
1182 
1183 	if (flags & GPIO_OPEN_DRAIN)
1184 		repr = "open-drain";
1185 	else if (flags & GPIO_OPEN_SOURCE)
1186 		repr = "open-source";
1187 	else
1188 		repr = "push-pull";
1189 
1190 	return sprintf(page, "%s\n", repr);
1191 }
1192 
1193 static ssize_t
1194 gpio_virtuser_lookup_entry_config_drive_store(struct config_item *item,
1195 					      const char *page, size_t count)
1196 {
1197 	struct gpio_virtuser_lookup_entry *entry =
1198 					to_gpio_virtuser_lookup_entry(item);
1199 	struct gpio_virtuser_device *dev = entry->parent->parent;
1200 
1201 	guard(mutex)(&dev->lock);
1202 
1203 	if (gpio_virtuser_device_is_live(dev))
1204 		return -EBUSY;
1205 
1206 	if (sysfs_streq(page, "push-pull")) {
1207 		entry->flags &= ~(GPIO_OPEN_DRAIN | GPIO_OPEN_SOURCE);
1208 	} else if (sysfs_streq(page, "open-drain")) {
1209 		entry->flags &= ~GPIO_OPEN_SOURCE;
1210 		entry->flags |= GPIO_OPEN_DRAIN;
1211 	} else if (sysfs_streq(page, "open-source")) {
1212 		entry->flags &= ~GPIO_OPEN_DRAIN;
1213 		entry->flags |= GPIO_OPEN_SOURCE;
1214 	} else {
1215 		count = -EINVAL;
1216 	}
1217 
1218 	return count;
1219 }
1220 
1221 CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, drive);
1222 
1223 static ssize_t
1224 gpio_virtuser_lookup_entry_config_pull_show(struct config_item *item, char *page)
1225 {
1226 	enum gpio_lookup_flags flags = gpio_virtuser_lookup_get_flags(item);
1227 	const char *repr;
1228 
1229 	if (flags & GPIO_PULL_UP)
1230 		repr = "pull-up";
1231 	else if (flags & GPIO_PULL_DOWN)
1232 		repr = "pull-down";
1233 	else if (flags & GPIO_PULL_DISABLE)
1234 		repr = "pull-disabled";
1235 	else
1236 		repr = "as-is";
1237 
1238 	return sprintf(page, "%s\n", repr);
1239 }
1240 
1241 static ssize_t
1242 gpio_virtuser_lookup_entry_config_pull_store(struct config_item *item,
1243 					     const char *page, size_t count)
1244 {
1245 	struct gpio_virtuser_lookup_entry *entry =
1246 					to_gpio_virtuser_lookup_entry(item);
1247 	struct gpio_virtuser_device *dev = entry->parent->parent;
1248 
1249 	guard(mutex)(&dev->lock);
1250 
1251 	if (gpio_virtuser_device_is_live(dev))
1252 		return -EBUSY;
1253 
1254 	if (sysfs_streq(page, "pull-up")) {
1255 		entry->flags &= ~(GPIO_PULL_DOWN | GPIO_PULL_DISABLE);
1256 		entry->flags |= GPIO_PULL_UP;
1257 	} else if (sysfs_streq(page, "pull-down")) {
1258 		entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DISABLE);
1259 		entry->flags |= GPIO_PULL_DOWN;
1260 	} else if (sysfs_streq(page, "pull-disabled")) {
1261 		entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DOWN);
1262 		entry->flags |= GPIO_PULL_DISABLE;
1263 	} else if (sysfs_streq(page, "as-is")) {
1264 		entry->flags &= ~(GPIO_PULL_UP | GPIO_PULL_DOWN |
1265 				  GPIO_PULL_DISABLE);
1266 	} else {
1267 		count = -EINVAL;
1268 	}
1269 
1270 	return count;
1271 }
1272 
1273 CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, pull);
1274 
1275 static ssize_t
1276 gpio_virtuser_lookup_entry_config_active_low_show(struct config_item *item,
1277 						  char *page)
1278 {
1279 	enum gpio_lookup_flags flags = gpio_virtuser_lookup_get_flags(item);
1280 
1281 	return sprintf(page, "%c\n", flags & GPIO_ACTIVE_LOW ? '1' : '0');
1282 }
1283 
1284 static ssize_t
1285 gpio_virtuser_lookup_entry_config_active_low_store(struct config_item *item,
1286 						   const char *page,
1287 						   size_t count)
1288 {
1289 	struct gpio_virtuser_lookup_entry *entry =
1290 					to_gpio_virtuser_lookup_entry(item);
1291 	struct gpio_virtuser_device *dev = entry->parent->parent;
1292 	bool active_low;
1293 	int ret;
1294 
1295 	ret = kstrtobool(page, &active_low);
1296 	if (ret)
1297 		return ret;
1298 
1299 	guard(mutex)(&dev->lock);
1300 
1301 	if (gpio_virtuser_device_is_live(dev))
1302 		return -EBUSY;
1303 
1304 	if (active_low)
1305 		entry->flags |= GPIO_ACTIVE_LOW;
1306 	else
1307 		entry->flags &= ~GPIO_ACTIVE_LOW;
1308 
1309 	return count;
1310 }
1311 
1312 CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, active_low);
1313 
1314 static ssize_t
1315 gpio_virtuser_lookup_entry_config_transitory_show(struct config_item *item,
1316 						  char *page)
1317 {
1318 	enum gpio_lookup_flags flags = gpio_virtuser_lookup_get_flags(item);
1319 
1320 	return sprintf(page, "%c\n", flags & GPIO_TRANSITORY ? '1' : '0');
1321 }
1322 
1323 static ssize_t
1324 gpio_virtuser_lookup_entry_config_transitory_store(struct config_item *item,
1325 						   const char *page,
1326 						   size_t count)
1327 {
1328 	struct gpio_virtuser_lookup_entry *entry =
1329 					to_gpio_virtuser_lookup_entry(item);
1330 	struct gpio_virtuser_device *dev = entry->parent->parent;
1331 	bool transitory;
1332 	int ret;
1333 
1334 	ret = kstrtobool(page, &transitory);
1335 	if (ret)
1336 		return ret;
1337 
1338 	guard(mutex)(&dev->lock);
1339 
1340 	if (gpio_virtuser_device_is_live(dev))
1341 		return -EBUSY;
1342 
1343 	if (transitory)
1344 		entry->flags |= GPIO_TRANSITORY;
1345 	else
1346 		entry->flags &= ~GPIO_TRANSITORY;
1347 
1348 	return count;
1349 }
1350 
1351 CONFIGFS_ATTR(gpio_virtuser_lookup_entry_config_, transitory);
1352 
1353 static struct configfs_attribute *gpio_virtuser_lookup_entry_config_attrs[] = {
1354 	&gpio_virtuser_lookup_entry_config_attr_key,
1355 	&gpio_virtuser_lookup_entry_config_attr_offset,
1356 	&gpio_virtuser_lookup_entry_config_attr_drive,
1357 	&gpio_virtuser_lookup_entry_config_attr_pull,
1358 	&gpio_virtuser_lookup_entry_config_attr_active_low,
1359 	&gpio_virtuser_lookup_entry_config_attr_transitory,
1360 	NULL
1361 };
1362 
1363 static ssize_t
1364 gpio_virtuser_device_config_dev_name_show(struct config_item *item,
1365 					  char *page)
1366 {
1367 	struct gpio_virtuser_device *dev = to_gpio_virtuser_device(item);
1368 	struct platform_device *pdev;
1369 
1370 	guard(mutex)(&dev->lock);
1371 
1372 	pdev = dev->pdev;
1373 	if (pdev)
1374 		return sprintf(page, "%s\n", dev_name(&pdev->dev));
1375 
1376 	return sprintf(page, "gpio-sim.%d\n", dev->id);
1377 }
1378 
1379 CONFIGFS_ATTR_RO(gpio_virtuser_device_config_, dev_name);
1380 
1381 static ssize_t gpio_virtuser_device_config_live_show(struct config_item *item,
1382 						     char *page)
1383 {
1384 	struct gpio_virtuser_device *dev = to_gpio_virtuser_device(item);
1385 	bool live;
1386 
1387 	scoped_guard(mutex, &dev->lock)
1388 		live = gpio_virtuser_device_is_live(dev);
1389 
1390 	return sprintf(page, "%c\n", live ? '1' : '0');
1391 }
1392 
1393 static size_t
1394 gpio_virtuser_get_lookup_count(struct gpio_virtuser_device *dev)
1395 {
1396 	struct gpio_virtuser_lookup *lookup;
1397 	size_t count = 0;
1398 
1399 	lockdep_assert_held(&dev->lock);
1400 
1401 	list_for_each_entry(lookup, &dev->lookup_list, siblings)
1402 		count += list_count_nodes(&lookup->entry_list);
1403 
1404 	return count;
1405 }
1406 
1407 static int
1408 gpio_virtuser_make_lookup_table(struct gpio_virtuser_device *dev)
1409 {
1410 	size_t num_entries = gpio_virtuser_get_lookup_count(dev);
1411 	struct gpio_virtuser_lookup_entry *entry;
1412 	struct gpio_virtuser_lookup *lookup;
1413 	unsigned int i = 0;
1414 
1415 	lockdep_assert_held(&dev->lock);
1416 
1417 	struct gpiod_lookup_table *table __free(kfree) =
1418 		kzalloc(struct_size(table, table, num_entries + 1), GFP_KERNEL);
1419 	if (!table)
1420 		return -ENOMEM;
1421 
1422 	table->dev_id = kasprintf(GFP_KERNEL, "gpio-virtuser.%d", dev->id);
1423 	if (!table->dev_id)
1424 		return -ENOMEM;
1425 
1426 	list_for_each_entry(lookup, &dev->lookup_list, siblings) {
1427 		list_for_each_entry(entry, &lookup->entry_list, siblings) {
1428 			table->table[i] =
1429 				GPIO_LOOKUP_IDX(entry->key,
1430 						entry->offset < 0 ? U16_MAX : entry->offset,
1431 						lookup->con_id, i, entry->flags);
1432 			i++;
1433 		}
1434 	}
1435 
1436 	gpiod_add_lookup_table(table);
1437 	dev->lookup_table = no_free_ptr(table);
1438 
1439 	return 0;
1440 }
1441 
1442 static struct fwnode_handle *
1443 gpio_virtuser_make_device_swnode(struct gpio_virtuser_device *dev)
1444 {
1445 	struct property_entry properties[2];
1446 	struct gpio_virtuser_lookup *lookup;
1447 	unsigned int i = 0;
1448 	size_t num_ids;
1449 
1450 	memset(properties, 0, sizeof(properties));
1451 
1452 	num_ids = list_count_nodes(&dev->lookup_list);
1453 	char **ids __free(kfree) = kcalloc(num_ids + 1, sizeof(*ids),
1454 					   GFP_KERNEL);
1455 	if (!ids)
1456 		return ERR_PTR(-ENOMEM);
1457 
1458 	list_for_each_entry(lookup, &dev->lookup_list, siblings)
1459 		ids[i++] = lookup->con_id;
1460 
1461 	properties[0] = PROPERTY_ENTRY_STRING_ARRAY_LEN("gpio-virtuser,ids",
1462 							ids, num_ids);
1463 
1464 	return fwnode_create_software_node(properties, NULL);
1465 }
1466 
1467 static int
1468 gpio_virtuser_device_activate(struct gpio_virtuser_device *dev)
1469 {
1470 	struct platform_device_info pdevinfo;
1471 	struct fwnode_handle *swnode;
1472 	struct platform_device *pdev;
1473 	int ret;
1474 
1475 	lockdep_assert_held(&dev->lock);
1476 
1477 	if (list_empty(&dev->lookup_list))
1478 		return -ENODATA;
1479 
1480 	swnode = gpio_virtuser_make_device_swnode(dev);
1481 	if (IS_ERR(swnode))
1482 		return PTR_ERR(swnode);
1483 
1484 	memset(&pdevinfo, 0, sizeof(pdevinfo));
1485 	pdevinfo.name = "gpio-virtuser";
1486 	pdevinfo.id = dev->id;
1487 	pdevinfo.fwnode = swnode;
1488 
1489 	ret = gpio_virtuser_make_lookup_table(dev);
1490 	if (ret) {
1491 		fwnode_remove_software_node(swnode);
1492 		return ret;
1493 	}
1494 
1495 	reinit_completion(&dev->probe_completion);
1496 	dev->driver_bound = false;
1497 	bus_register_notifier(&platform_bus_type, &dev->bus_notifier);
1498 
1499 	pdev = platform_device_register_full(&pdevinfo);
1500 	if (IS_ERR(pdev)) {
1501 		bus_unregister_notifier(&platform_bus_type, &dev->bus_notifier);
1502 		fwnode_remove_software_node(swnode);
1503 		return PTR_ERR(pdev);
1504 	}
1505 
1506 	wait_for_completion(&dev->probe_completion);
1507 	bus_unregister_notifier(&platform_bus_type, &dev->bus_notifier);
1508 
1509 	if (!dev->driver_bound) {
1510 		platform_device_unregister(pdev);
1511 		fwnode_remove_software_node(swnode);
1512 		return -ENXIO;
1513 	}
1514 
1515 	dev->pdev = pdev;
1516 
1517 	return 0;
1518 }
1519 
1520 static void
1521 gpio_virtuser_device_deactivate(struct gpio_virtuser_device *dev)
1522 {
1523 	struct fwnode_handle *swnode;
1524 
1525 	lockdep_assert_held(&dev->lock);
1526 
1527 	swnode = dev_fwnode(&dev->pdev->dev);
1528 	platform_device_unregister(dev->pdev);
1529 	fwnode_remove_software_node(swnode);
1530 	dev->pdev = NULL;
1531 	gpiod_remove_lookup_table(dev->lookup_table);
1532 	kfree(dev->lookup_table);
1533 }
1534 
1535 static ssize_t
1536 gpio_virtuser_device_config_live_store(struct config_item *item,
1537 				       const char *page, size_t count)
1538 {
1539 	struct gpio_virtuser_device *dev = to_gpio_virtuser_device(item);
1540 	int ret = 0;
1541 	bool live;
1542 
1543 	ret = kstrtobool(page, &live);
1544 	if (ret)
1545 		return ret;
1546 
1547 	guard(mutex)(&dev->lock);
1548 
1549 	if (live == gpio_virtuser_device_is_live(dev))
1550 		return -EPERM;
1551 
1552 	if (live)
1553 		ret = gpio_virtuser_device_activate(dev);
1554 	else
1555 		gpio_virtuser_device_deactivate(dev);
1556 
1557 	return ret ?: count;
1558 }
1559 
1560 CONFIGFS_ATTR(gpio_virtuser_device_config_, live);
1561 
1562 static struct configfs_attribute *gpio_virtuser_device_config_attrs[] = {
1563 	&gpio_virtuser_device_config_attr_dev_name,
1564 	&gpio_virtuser_device_config_attr_live,
1565 	NULL
1566 };
1567 
1568 static void
1569 gpio_virtuser_lookup_entry_config_group_release(struct config_item *item)
1570 {
1571 	struct gpio_virtuser_lookup_entry *entry =
1572 					to_gpio_virtuser_lookup_entry(item);
1573 	struct gpio_virtuser_device *dev = entry->parent->parent;
1574 
1575 	guard(mutex)(&dev->lock);
1576 
1577 	list_del(&entry->siblings);
1578 
1579 	kfree(entry->key);
1580 	kfree(entry);
1581 }
1582 
1583 static struct
1584 configfs_item_operations gpio_virtuser_lookup_entry_config_item_ops = {
1585 	.release	= gpio_virtuser_lookup_entry_config_group_release,
1586 };
1587 
1588 static const struct
1589 config_item_type gpio_virtuser_lookup_entry_config_group_type = {
1590 	.ct_item_ops	= &gpio_virtuser_lookup_entry_config_item_ops,
1591 	.ct_attrs	= gpio_virtuser_lookup_entry_config_attrs,
1592 	.ct_owner	= THIS_MODULE,
1593 };
1594 
1595 static struct config_group *
1596 gpio_virtuser_make_lookup_entry_group(struct config_group *group,
1597 				      const char *name)
1598 {
1599 	struct gpio_virtuser_lookup *lookup =
1600 				to_gpio_virtuser_lookup(&group->cg_item);
1601 	struct gpio_virtuser_device *dev = lookup->parent;
1602 
1603 	guard(mutex)(&dev->lock);
1604 
1605 	if (gpio_virtuser_device_is_live(dev))
1606 		return ERR_PTR(-EBUSY);
1607 
1608 	struct gpio_virtuser_lookup_entry *entry __free(kfree) =
1609 				kzalloc(sizeof(*entry), GFP_KERNEL);
1610 	if (!entry)
1611 		return ERR_PTR(-ENOMEM);
1612 
1613 	config_group_init_type_name(&entry->group, name,
1614 			&gpio_virtuser_lookup_entry_config_group_type);
1615 	entry->flags = GPIO_LOOKUP_FLAGS_DEFAULT;
1616 	entry->parent = lookup;
1617 	list_add_tail(&entry->siblings, &lookup->entry_list);
1618 
1619 	return &no_free_ptr(entry)->group;
1620 }
1621 
1622 static void gpio_virtuser_lookup_config_group_release(struct config_item *item)
1623 {
1624 	struct gpio_virtuser_lookup *lookup = to_gpio_virtuser_lookup(item);
1625 	struct gpio_virtuser_device *dev = lookup->parent;
1626 
1627 	guard(mutex)(&dev->lock);
1628 
1629 	list_del(&lookup->siblings);
1630 
1631 	kfree(lookup->con_id);
1632 	kfree(lookup);
1633 }
1634 
1635 static struct configfs_item_operations gpio_virtuser_lookup_config_item_ops = {
1636 	.release	= gpio_virtuser_lookup_config_group_release,
1637 };
1638 
1639 static struct
1640 configfs_group_operations gpio_virtuser_lookup_config_group_ops = {
1641 	.make_group     = gpio_virtuser_make_lookup_entry_group,
1642 };
1643 
1644 static const struct config_item_type gpio_virtuser_lookup_config_group_type = {
1645 	.ct_group_ops	= &gpio_virtuser_lookup_config_group_ops,
1646 	.ct_item_ops	= &gpio_virtuser_lookup_config_item_ops,
1647 	.ct_owner	= THIS_MODULE,
1648 };
1649 
1650 static struct config_group *
1651 gpio_virtuser_make_lookup_group(struct config_group *group, const char *name)
1652 {
1653 	struct gpio_virtuser_device *dev =
1654 				to_gpio_virtuser_device(&group->cg_item);
1655 
1656 	if (strlen(name) > (GPIO_VIRTUSER_NAME_BUF_LEN - 1))
1657 		return ERR_PTR(-E2BIG);
1658 
1659 	guard(mutex)(&dev->lock);
1660 
1661 	if (gpio_virtuser_device_is_live(dev))
1662 		return ERR_PTR(-EBUSY);
1663 
1664 	struct gpio_virtuser_lookup *lookup __free(kfree) =
1665 				kzalloc(sizeof(*lookup), GFP_KERNEL);
1666 	if (!lookup)
1667 		return ERR_PTR(-ENOMEM);
1668 
1669 	lookup->con_id = kstrdup(name, GFP_KERNEL);
1670 	if (!lookup->con_id)
1671 		return ERR_PTR(-ENOMEM);
1672 
1673 	config_group_init_type_name(&lookup->group, name,
1674 				    &gpio_virtuser_lookup_config_group_type);
1675 	INIT_LIST_HEAD(&lookup->entry_list);
1676 	lookup->parent = dev;
1677 	list_add_tail(&lookup->siblings, &dev->lookup_list);
1678 
1679 	return &no_free_ptr(lookup)->group;
1680 }
1681 
1682 static void gpio_virtuser_device_config_group_release(struct config_item *item)
1683 {
1684 	struct gpio_virtuser_device *dev = to_gpio_virtuser_device(item);
1685 
1686 	guard(mutex)(&dev->lock);
1687 
1688 	if (gpio_virtuser_device_is_live(dev))
1689 		gpio_virtuser_device_deactivate(dev);
1690 
1691 	mutex_destroy(&dev->lock);
1692 	ida_free(&gpio_virtuser_ida, dev->id);
1693 	kfree(dev);
1694 }
1695 
1696 static struct configfs_item_operations gpio_virtuser_device_config_item_ops = {
1697 	.release	= gpio_virtuser_device_config_group_release,
1698 };
1699 
1700 static struct configfs_group_operations gpio_virtuser_device_config_group_ops = {
1701 	.make_group	= gpio_virtuser_make_lookup_group,
1702 };
1703 
1704 static const struct config_item_type gpio_virtuser_device_config_group_type = {
1705 	.ct_group_ops	= &gpio_virtuser_device_config_group_ops,
1706 	.ct_item_ops	= &gpio_virtuser_device_config_item_ops,
1707 	.ct_attrs	= gpio_virtuser_device_config_attrs,
1708 	.ct_owner	= THIS_MODULE,
1709 };
1710 
1711 static struct config_group *
1712 gpio_virtuser_config_make_device_group(struct config_group *group,
1713 				       const char *name)
1714 {
1715 	struct gpio_virtuser_device *dev __free(kfree) = kzalloc(sizeof(*dev),
1716 								 GFP_KERNEL);
1717 	if (!dev)
1718 		return ERR_PTR(-ENOMEM);
1719 
1720 	dev->id = ida_alloc(&gpio_virtuser_ida, GFP_KERNEL);
1721 	if (dev->id < 0)
1722 		return ERR_PTR(dev->id);
1723 
1724 	config_group_init_type_name(&dev->group, name,
1725 				    &gpio_virtuser_device_config_group_type);
1726 	mutex_init(&dev->lock);
1727 	INIT_LIST_HEAD(&dev->lookup_list);
1728 	dev->bus_notifier.notifier_call = gpio_virtuser_bus_notifier_call;
1729 	init_completion(&dev->probe_completion);
1730 
1731 	return &no_free_ptr(dev)->group;
1732 }
1733 
1734 static struct configfs_group_operations gpio_virtuser_config_group_ops = {
1735 	.make_group	= gpio_virtuser_config_make_device_group,
1736 };
1737 
1738 static const struct config_item_type gpio_virtuser_config_type = {
1739 	.ct_group_ops	= &gpio_virtuser_config_group_ops,
1740 	.ct_owner	= THIS_MODULE,
1741 };
1742 
1743 static struct configfs_subsystem gpio_virtuser_config_subsys = {
1744 	.su_group = {
1745 		.cg_item = {
1746 			.ci_namebuf	= "gpio-virtuser",
1747 			.ci_type	= &gpio_virtuser_config_type,
1748 		},
1749 	},
1750 };
1751 
1752 static int __init gpio_virtuser_init(void)
1753 {
1754 	int ret;
1755 
1756 	ret = platform_driver_register(&gpio_virtuser_driver);
1757 	if (ret) {
1758 		pr_err("Failed to register the platform driver: %d\n", ret);
1759 		return ret;
1760 	}
1761 
1762 	config_group_init(&gpio_virtuser_config_subsys.su_group);
1763 	mutex_init(&gpio_virtuser_config_subsys.su_mutex);
1764 	ret = configfs_register_subsystem(&gpio_virtuser_config_subsys);
1765 	if (ret) {
1766 		pr_err("Failed to register the '%s' configfs subsystem: %d\n",
1767 		       gpio_virtuser_config_subsys.su_group.cg_item.ci_namebuf,
1768 		       ret);
1769 		goto err_plat_drv_unreg;
1770 	}
1771 
1772 	gpio_virtuser_dbg_root = debugfs_create_dir("gpio-virtuser", NULL);
1773 	if (IS_ERR(gpio_virtuser_dbg_root)) {
1774 		ret = PTR_ERR(gpio_virtuser_dbg_root);
1775 		pr_err("Failed to create the debugfs tree: %d\n", ret);
1776 		goto err_configfs_unreg;
1777 	}
1778 
1779 	return 0;
1780 
1781 err_configfs_unreg:
1782 	configfs_unregister_subsystem(&gpio_virtuser_config_subsys);
1783 err_plat_drv_unreg:
1784 	mutex_destroy(&gpio_virtuser_config_subsys.su_mutex);
1785 	platform_driver_unregister(&gpio_virtuser_driver);
1786 
1787 	return ret;
1788 }
1789 module_init(gpio_virtuser_init);
1790 
1791 static void __exit gpio_virtuser_exit(void)
1792 {
1793 	configfs_unregister_subsystem(&gpio_virtuser_config_subsys);
1794 	mutex_destroy(&gpio_virtuser_config_subsys.su_mutex);
1795 	platform_driver_unregister(&gpio_virtuser_driver);
1796 	debugfs_remove_recursive(gpio_virtuser_dbg_root);
1797 }
1798 module_exit(gpio_virtuser_exit);
1799 
1800 MODULE_AUTHOR("Bartosz Golaszewski <bartosz.golaszewski@linaro.org>");
1801 MODULE_DESCRIPTION("Virtual GPIO consumer module");
1802 MODULE_LICENSE("GPL");
1803