]> www.pilppa.org Git - linux-2.6-omap-h63xx.git/blob - drivers/i2c/chips/twl4030-pwrbutton.c
twl4030-pwrirq simplification, cleanup
[linux-2.6-omap-h63xx.git] / drivers / i2c / chips / twl4030-pwrbutton.c
1 /**
2  * drivers/i2c/chips/twl4030-pwrbutton.c
3  *
4  * Driver for sending triton2 power button event to input-layer
5  *
6  * Copyright (C) 2008 Nokia Corporation
7  *
8  * Written by Peter De Schrijver <peter.de-schrijver@nokia.com>
9  *
10  * This file is subject to the terms and conditions of the GNU General
11  * Public License. See the file "COPYING" in the main directory of this
12  * archive for more details.
13  *
14  * This program is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  * GNU General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program; if not, write to the Free Software
21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
22  */
23
24 #include <linux/module.h>
25 #include <linux/init.h>
26 #include <linux/kernel.h>
27 #include <linux/errno.h>
28 #include <linux/input.h>
29 #include <linux/interrupt.h>
30 #include <linux/i2c/twl4030.h>
31
32 #define PWR_ISR1 0
33 #define PWR_IMR1 1
34 #define PWR_PWRON_IRQ (1<<0)
35
36 #define PWR_EDR1 5
37 #define PWR_PWRON_RISING (1<<1)
38 #define PWR_PWRON_FALLING  (1<<0)
39 #define PWR_PWRON_BOTH (PWR_PWRON_RISING | PWR_PWRON_FALLING)
40
41 #define PWR_SIH_CTRL 7
42
43 #define STS_HW_CONDITIONS 0xf
44
45 static struct input_dev *powerbutton_dev;
46
47 static irqreturn_t powerbutton_irq(int irq, void *dev_id)
48 {
49         int err;
50         u8 value;
51
52 #ifdef CONFIG_LOCKDEP
53         /* WORKAROUND for lockdep forcing IRQF_DISABLED on us, which
54          * we don't want and can't tolerate.  Although it might be
55          * friendlier not to borrow this thread context...
56          */
57         local_irq_enable();
58 #endif
59
60         err = twl4030_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &value,
61                                   STS_HW_CONDITIONS);
62         if (!err)  {
63                 input_report_key(powerbutton_dev, KEY_POWER,
64                                  value & PWR_PWRON_IRQ);
65         } else {
66                 pr_err("twl4030: i2c error %d while reading TWL4030"
67                         " PM_MASTER STS_HW_CONDITIONS register\n", err);
68         }
69
70         return IRQ_HANDLED;
71 }
72
73 static int __init twl4030_pwrbutton_init(void)
74 {
75         int err = 0;
76         u8 value;
77
78         /* PWRBTN == PWRON */
79         if (request_irq(TWL4030_PWRIRQ_PWRBTN, powerbutton_irq, 0,
80                         "PwrButton", NULL) < 0) {
81                 printk(KERN_ERR "Unable to allocate IRQ for power button\n");
82                 err = -EBUSY;
83                 goto out;
84         }
85
86         powerbutton_dev = input_allocate_device();
87         if (!powerbutton_dev) {
88                 printk(KERN_ERR
89                         "Unable to allocate input device for power button\n");
90                 err = -ENOMEM;
91                 goto free_irq_and_out;
92         }
93
94         powerbutton_dev->evbit[0] = BIT_MASK(EV_KEY);
95         powerbutton_dev->keybit[BIT_WORD(KEY_POWER)] = BIT_MASK(KEY_POWER);
96         powerbutton_dev->name = "triton2-pwrbutton";
97
98         err = input_register_device(powerbutton_dev);
99         if (err) {
100                 input_free_device(powerbutton_dev);
101                 goto free_irq_and_out;
102         }
103
104         /* FIXME just pass IRQF_EDGE_FALLING | IRQF_EDGE_RISING
105          * to request_irq(), once MODULE_INT supports them...
106          */
107         err = twl4030_i2c_read_u8(TWL4030_MODULE_INT, &value, PWR_EDR1);
108         if (err) {
109                 printk(KERN_WARNING "I2C error %d while reading TWL4030"
110                                         " INT PWR_EDR1 register\n", err);
111                 goto free_input_dev;
112         }
113
114         err = twl4030_i2c_write_u8(TWL4030_MODULE_INT,
115                                    value | PWR_PWRON_BOTH, PWR_EDR1);
116
117         if (err) {
118                 printk(KERN_WARNING "I2C error %d while writing TWL4030"
119                                         " INT PWR_EDR1 register\n", err);
120                 goto free_input_dev;
121         }
122
123         printk(KERN_INFO "triton2 power button driver initialized\n");
124
125         return 0;
126
127
128 free_input_dev:
129         input_unregister_device(powerbutton_dev);
130 free_irq_and_out:
131         free_irq(TWL4030_PWRIRQ_PWRBTN, NULL);
132 out:
133         return err;
134 }
135 module_init(twl4030_pwrbutton_init);
136
137 static void __exit twl4030_pwrbutton_exit(void)
138 {
139         free_irq(TWL4030_PWRIRQ_PWRBTN, NULL);
140         input_unregister_device(powerbutton_dev);
141         input_free_device(powerbutton_dev);
142 }
143 module_exit(twl4030_pwrbutton_exit);
144
145 MODULE_DESCRIPTION("Triton2 Power Button");
146 MODULE_LICENSE("GPL");
147 MODULE_AUTHOR("Peter De Schrijver");
148