xref: /OK3568_Linux_fs/kernel/drivers/input/misc/gpio-beeper.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Generic GPIO beeper driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2013-2014 Alexander Shiyan <shc_work@mail.ru>
6*4882a593Smuzhiyun  */
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun #include <linux/input.h>
9*4882a593Smuzhiyun #include <linux/module.h>
10*4882a593Smuzhiyun #include <linux/gpio/consumer.h>
11*4882a593Smuzhiyun #include <linux/of.h>
12*4882a593Smuzhiyun #include <linux/workqueue.h>
13*4882a593Smuzhiyun #include <linux/platform_device.h>
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun #define BEEPER_MODNAME		"gpio-beeper"
16*4882a593Smuzhiyun 
17*4882a593Smuzhiyun struct gpio_beeper {
18*4882a593Smuzhiyun 	struct work_struct	work;
19*4882a593Smuzhiyun 	struct gpio_desc	*desc;
20*4882a593Smuzhiyun 	bool			beeping;
21*4882a593Smuzhiyun };
22*4882a593Smuzhiyun 
gpio_beeper_toggle(struct gpio_beeper * beep,bool on)23*4882a593Smuzhiyun static void gpio_beeper_toggle(struct gpio_beeper *beep, bool on)
24*4882a593Smuzhiyun {
25*4882a593Smuzhiyun 	gpiod_set_value_cansleep(beep->desc, on);
26*4882a593Smuzhiyun }
27*4882a593Smuzhiyun 
gpio_beeper_work(struct work_struct * work)28*4882a593Smuzhiyun static void gpio_beeper_work(struct work_struct *work)
29*4882a593Smuzhiyun {
30*4882a593Smuzhiyun 	struct gpio_beeper *beep = container_of(work, struct gpio_beeper, work);
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun 	gpio_beeper_toggle(beep, beep->beeping);
33*4882a593Smuzhiyun }
34*4882a593Smuzhiyun 
gpio_beeper_event(struct input_dev * dev,unsigned int type,unsigned int code,int value)35*4882a593Smuzhiyun static int gpio_beeper_event(struct input_dev *dev, unsigned int type,
36*4882a593Smuzhiyun 			     unsigned int code, int value)
37*4882a593Smuzhiyun {
38*4882a593Smuzhiyun 	struct gpio_beeper *beep = input_get_drvdata(dev);
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun 	if (type != EV_SND || code != SND_BELL)
41*4882a593Smuzhiyun 		return -ENOTSUPP;
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun 	if (value < 0)
44*4882a593Smuzhiyun 		return -EINVAL;
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun 	beep->beeping = value;
47*4882a593Smuzhiyun 	/* Schedule work to actually turn the beeper on or off */
48*4882a593Smuzhiyun 	schedule_work(&beep->work);
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun 	return 0;
51*4882a593Smuzhiyun }
52*4882a593Smuzhiyun 
gpio_beeper_close(struct input_dev * input)53*4882a593Smuzhiyun static void gpio_beeper_close(struct input_dev *input)
54*4882a593Smuzhiyun {
55*4882a593Smuzhiyun 	struct gpio_beeper *beep = input_get_drvdata(input);
56*4882a593Smuzhiyun 
57*4882a593Smuzhiyun 	cancel_work_sync(&beep->work);
58*4882a593Smuzhiyun 	gpio_beeper_toggle(beep, false);
59*4882a593Smuzhiyun }
60*4882a593Smuzhiyun 
gpio_beeper_probe(struct platform_device * pdev)61*4882a593Smuzhiyun static int gpio_beeper_probe(struct platform_device *pdev)
62*4882a593Smuzhiyun {
63*4882a593Smuzhiyun 	struct gpio_beeper *beep;
64*4882a593Smuzhiyun 	struct input_dev *input;
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun 	beep = devm_kzalloc(&pdev->dev, sizeof(*beep), GFP_KERNEL);
67*4882a593Smuzhiyun 	if (!beep)
68*4882a593Smuzhiyun 		return -ENOMEM;
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun 	beep->desc = devm_gpiod_get(&pdev->dev, NULL, GPIOD_OUT_LOW);
71*4882a593Smuzhiyun 	if (IS_ERR(beep->desc))
72*4882a593Smuzhiyun 		return PTR_ERR(beep->desc);
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun 	input = devm_input_allocate_device(&pdev->dev);
75*4882a593Smuzhiyun 	if (!input)
76*4882a593Smuzhiyun 		return -ENOMEM;
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun 	INIT_WORK(&beep->work, gpio_beeper_work);
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun 	input->name		= pdev->name;
81*4882a593Smuzhiyun 	input->id.bustype	= BUS_HOST;
82*4882a593Smuzhiyun 	input->id.vendor	= 0x0001;
83*4882a593Smuzhiyun 	input->id.product	= 0x0001;
84*4882a593Smuzhiyun 	input->id.version	= 0x0100;
85*4882a593Smuzhiyun 	input->close		= gpio_beeper_close;
86*4882a593Smuzhiyun 	input->event		= gpio_beeper_event;
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun 	input_set_capability(input, EV_SND, SND_BELL);
89*4882a593Smuzhiyun 
90*4882a593Smuzhiyun 	input_set_drvdata(input, beep);
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun 	return input_register_device(input);
93*4882a593Smuzhiyun }
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun #ifdef CONFIG_OF
96*4882a593Smuzhiyun static const struct of_device_id gpio_beeper_of_match[] = {
97*4882a593Smuzhiyun 	{ .compatible = BEEPER_MODNAME, },
98*4882a593Smuzhiyun 	{ }
99*4882a593Smuzhiyun };
100*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, gpio_beeper_of_match);
101*4882a593Smuzhiyun #endif
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun static struct platform_driver gpio_beeper_platform_driver = {
104*4882a593Smuzhiyun 	.driver	= {
105*4882a593Smuzhiyun 		.name		= BEEPER_MODNAME,
106*4882a593Smuzhiyun 		.of_match_table	= of_match_ptr(gpio_beeper_of_match),
107*4882a593Smuzhiyun 	},
108*4882a593Smuzhiyun 	.probe	= gpio_beeper_probe,
109*4882a593Smuzhiyun };
110*4882a593Smuzhiyun module_platform_driver(gpio_beeper_platform_driver);
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun MODULE_LICENSE("GPL");
113*4882a593Smuzhiyun MODULE_AUTHOR("Alexander Shiyan <shc_work@mail.ru>");
114*4882a593Smuzhiyun MODULE_DESCRIPTION("Generic GPIO beeper driver");
115