1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Generic push-switch framework
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (C) 2006 Paul Mundt
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun #include <linux/init.h>
8*4882a593Smuzhiyun #include <linux/slab.h>
9*4882a593Smuzhiyun #include <linux/module.h>
10*4882a593Smuzhiyun #include <linux/interrupt.h>
11*4882a593Smuzhiyun #include <linux/platform_device.h>
12*4882a593Smuzhiyun #include <asm/push-switch.h>
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun #define DRV_NAME "push-switch"
15*4882a593Smuzhiyun #define DRV_VERSION "0.1.1"
16*4882a593Smuzhiyun
switch_show(struct device * dev,struct device_attribute * attr,char * buf)17*4882a593Smuzhiyun static ssize_t switch_show(struct device *dev,
18*4882a593Smuzhiyun struct device_attribute *attr,
19*4882a593Smuzhiyun char *buf)
20*4882a593Smuzhiyun {
21*4882a593Smuzhiyun struct push_switch_platform_info *psw_info = dev->platform_data;
22*4882a593Smuzhiyun return sprintf(buf, "%s\n", psw_info->name);
23*4882a593Smuzhiyun }
24*4882a593Smuzhiyun static DEVICE_ATTR_RO(switch);
25*4882a593Smuzhiyun
switch_timer(struct timer_list * t)26*4882a593Smuzhiyun static void switch_timer(struct timer_list *t)
27*4882a593Smuzhiyun {
28*4882a593Smuzhiyun struct push_switch *psw = from_timer(psw, t, debounce);
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun schedule_work(&psw->work);
31*4882a593Smuzhiyun }
32*4882a593Smuzhiyun
switch_work_handler(struct work_struct * work)33*4882a593Smuzhiyun static void switch_work_handler(struct work_struct *work)
34*4882a593Smuzhiyun {
35*4882a593Smuzhiyun struct push_switch *psw = container_of(work, struct push_switch, work);
36*4882a593Smuzhiyun struct platform_device *pdev = psw->pdev;
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun psw->state = 0;
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun kobject_uevent(&pdev->dev.kobj, KOBJ_CHANGE);
41*4882a593Smuzhiyun }
42*4882a593Smuzhiyun
switch_drv_probe(struct platform_device * pdev)43*4882a593Smuzhiyun static int switch_drv_probe(struct platform_device *pdev)
44*4882a593Smuzhiyun {
45*4882a593Smuzhiyun struct push_switch_platform_info *psw_info;
46*4882a593Smuzhiyun struct push_switch *psw;
47*4882a593Smuzhiyun int ret, irq;
48*4882a593Smuzhiyun
49*4882a593Smuzhiyun psw = kzalloc(sizeof(struct push_switch), GFP_KERNEL);
50*4882a593Smuzhiyun if (unlikely(!psw))
51*4882a593Smuzhiyun return -ENOMEM;
52*4882a593Smuzhiyun
53*4882a593Smuzhiyun irq = platform_get_irq(pdev, 0);
54*4882a593Smuzhiyun if (unlikely(irq < 0)) {
55*4882a593Smuzhiyun ret = -ENODEV;
56*4882a593Smuzhiyun goto err;
57*4882a593Smuzhiyun }
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun psw_info = pdev->dev.platform_data;
60*4882a593Smuzhiyun BUG_ON(!psw_info);
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun ret = request_irq(irq, psw_info->irq_handler,
63*4882a593Smuzhiyun psw_info->irq_flags,
64*4882a593Smuzhiyun psw_info->name ? psw_info->name : DRV_NAME, pdev);
65*4882a593Smuzhiyun if (unlikely(ret < 0))
66*4882a593Smuzhiyun goto err;
67*4882a593Smuzhiyun
68*4882a593Smuzhiyun if (psw_info->name) {
69*4882a593Smuzhiyun ret = device_create_file(&pdev->dev, &dev_attr_switch);
70*4882a593Smuzhiyun if (unlikely(ret)) {
71*4882a593Smuzhiyun dev_err(&pdev->dev, "Failed creating device attrs\n");
72*4882a593Smuzhiyun ret = -EINVAL;
73*4882a593Smuzhiyun goto err_irq;
74*4882a593Smuzhiyun }
75*4882a593Smuzhiyun }
76*4882a593Smuzhiyun
77*4882a593Smuzhiyun INIT_WORK(&psw->work, switch_work_handler);
78*4882a593Smuzhiyun timer_setup(&psw->debounce, switch_timer, 0);
79*4882a593Smuzhiyun
80*4882a593Smuzhiyun /* Workqueue API brain-damage */
81*4882a593Smuzhiyun psw->pdev = pdev;
82*4882a593Smuzhiyun
83*4882a593Smuzhiyun platform_set_drvdata(pdev, psw);
84*4882a593Smuzhiyun
85*4882a593Smuzhiyun return 0;
86*4882a593Smuzhiyun
87*4882a593Smuzhiyun err_irq:
88*4882a593Smuzhiyun free_irq(irq, pdev);
89*4882a593Smuzhiyun err:
90*4882a593Smuzhiyun kfree(psw);
91*4882a593Smuzhiyun return ret;
92*4882a593Smuzhiyun }
93*4882a593Smuzhiyun
switch_drv_remove(struct platform_device * pdev)94*4882a593Smuzhiyun static int switch_drv_remove(struct platform_device *pdev)
95*4882a593Smuzhiyun {
96*4882a593Smuzhiyun struct push_switch *psw = platform_get_drvdata(pdev);
97*4882a593Smuzhiyun struct push_switch_platform_info *psw_info = pdev->dev.platform_data;
98*4882a593Smuzhiyun int irq = platform_get_irq(pdev, 0);
99*4882a593Smuzhiyun
100*4882a593Smuzhiyun if (psw_info->name)
101*4882a593Smuzhiyun device_remove_file(&pdev->dev, &dev_attr_switch);
102*4882a593Smuzhiyun
103*4882a593Smuzhiyun platform_set_drvdata(pdev, NULL);
104*4882a593Smuzhiyun flush_work(&psw->work);
105*4882a593Smuzhiyun del_timer_sync(&psw->debounce);
106*4882a593Smuzhiyun free_irq(irq, pdev);
107*4882a593Smuzhiyun
108*4882a593Smuzhiyun kfree(psw);
109*4882a593Smuzhiyun
110*4882a593Smuzhiyun return 0;
111*4882a593Smuzhiyun }
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun static struct platform_driver switch_driver = {
114*4882a593Smuzhiyun .probe = switch_drv_probe,
115*4882a593Smuzhiyun .remove = switch_drv_remove,
116*4882a593Smuzhiyun .driver = {
117*4882a593Smuzhiyun .name = DRV_NAME,
118*4882a593Smuzhiyun },
119*4882a593Smuzhiyun };
120*4882a593Smuzhiyun
switch_init(void)121*4882a593Smuzhiyun static int __init switch_init(void)
122*4882a593Smuzhiyun {
123*4882a593Smuzhiyun printk(KERN_NOTICE DRV_NAME ": version %s loaded\n", DRV_VERSION);
124*4882a593Smuzhiyun return platform_driver_register(&switch_driver);
125*4882a593Smuzhiyun }
126*4882a593Smuzhiyun
switch_exit(void)127*4882a593Smuzhiyun static void __exit switch_exit(void)
128*4882a593Smuzhiyun {
129*4882a593Smuzhiyun platform_driver_unregister(&switch_driver);
130*4882a593Smuzhiyun }
131*4882a593Smuzhiyun module_init(switch_init);
132*4882a593Smuzhiyun module_exit(switch_exit);
133*4882a593Smuzhiyun
134*4882a593Smuzhiyun MODULE_VERSION(DRV_VERSION);
135*4882a593Smuzhiyun MODULE_AUTHOR("Paul Mundt");
136*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
137