1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
|
/**
* twl6030-pwrbutton.c - TWL6030 Power Button Input Driver
*
* Copyright (C) 2011
*
* Written by Dan Murphy <DMurphy@ti.com>
*
* This file is subject to the terms and conditions of the GNU General
* Public License. See the file "COPYING" in the main directory of this
* archive for more details.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*
* Derived Work from: twl4030-pwrbutton.c from
* Peter De Schrijver <peter.de-schrijver@nokia.com>
* Felipe Balbi <felipe.balbi@nokia.com>
*
*/
#include <linux/module.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/i2c/twl.h>
#define PWR_PWRON_IRQ (1 << 0)
#define STS_HW_CONDITIONS 0x21
struct twl6030_pwr_button {
struct input_dev *input_dev;
struct device *dev;
int report_key;
};
static inline int twl6030_readb(struct twl6030_pwr_button *twl,
u8 module, u8 address)
{
u8 data = 0;
int ret = 0;
ret = twl_i2c_read_u8(module, &data, address);
if (ret >= 0)
ret = data;
else
dev_dbg(twl->dev,
"TWL6030:readb[0x%x,0x%x] Error %d\n",
module, address, ret);
return ret;
}
static inline int twl6030_writeb(struct twl6030_pwr_button *twl, u8 module,
u8 data, u8 address)
{
int ret = 0;
ret = twl_i2c_write_u8(module, data, address);
if (ret < 0)
dev_dbg(twl->dev,
"TWL6030:Write[0x%x] Error %d\n", address, ret);
return ret;
}
static irqreturn_t powerbutton_irq(int irq, void *_pwr)
{
struct twl6030_pwr_button *pwr = _pwr;
int hw_state;
hw_state = twl6030_readb(pwr, TWL6030_MODULE_ID0, STS_HW_CONDITIONS);
input_report_key(pwr->input_dev, pwr->report_key,
!(hw_state & PWR_PWRON_IRQ));
input_sync(pwr->input_dev);
return IRQ_HANDLED;
}
static int __devinit twl6030_pwrbutton_probe(struct platform_device *pdev)
{
struct twl6030_pwr_button *pwr_button;
int irq = platform_get_irq(pdev, 0);
int err = -ENODEV;
pr_info("%s: Enter\n", __func__);
pwr_button = kzalloc(sizeof(struct twl6030_pwr_button), GFP_KERNEL);
if (!pwr_button)
return -ENOMEM;
pwr_button->input_dev = input_allocate_device();
if (!pwr_button->input_dev) {
dev_dbg(&pdev->dev, "Can't allocate power button\n");
goto input_error;
}
__set_bit(EV_KEY, pwr_button->input_dev->evbit);
pwr_button->report_key = KEY_END;
pwr_button->dev = &pdev->dev;
pwr_button->input_dev->evbit[0] = BIT_MASK(EV_KEY);
pwr_button->input_dev->keybit[BIT_WORD(pwr_button->report_key)] =
BIT_MASK(pwr_button->report_key);
pwr_button->input_dev->name = "twl6030_pwrbutton";
pwr_button->input_dev->phys = "twl6030_pwrbutton/input0";
pwr_button->input_dev->dev.parent = &pdev->dev;
err = request_threaded_irq(irq, NULL, powerbutton_irq,
IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING,
"twl6030_pwrbutton", pwr_button);
if (err < 0) {
dev_dbg(&pdev->dev, "Can't get IRQ for pwrbutton: %d\n", err);
goto free_input_dev;
}
err = input_register_device(pwr_button->input_dev);
if (err) {
dev_dbg(&pdev->dev, "Can't register power button: %d\n", err);
goto free_irq;
}
twl6030_interrupt_unmask(0x01, REG_INT_MSK_LINE_A);
twl6030_interrupt_unmask(0x01, REG_INT_MSK_STS_A);
platform_set_drvdata(pdev, pwr_button);
return 0;
free_irq:
free_irq(irq, NULL);
free_input_dev:
input_free_device(pwr_button->input_dev);
input_error:
kfree(pwr_button);
return err;
}
static int __devexit twl6030_pwrbutton_remove(struct platform_device *pdev)
{
struct input_dev *pwr = platform_get_drvdata(pdev);
int irq = platform_get_irq(pdev, 0);
free_irq(irq, pwr);
input_unregister_device(pwr);
return 0;
}
struct platform_driver twl6030_pwrbutton_driver = {
.probe = twl6030_pwrbutton_probe,
.remove = __devexit_p(twl6030_pwrbutton_remove),
.driver = {
.name = "twl6030_pwrbutton",
.owner = THIS_MODULE,
},
};
static int __init twl6030_pwrbutton_init(void)
{
return platform_driver_register(&twl6030_pwrbutton_driver);
}
module_init(twl6030_pwrbutton_init);
static void __exit twl6030_pwrbutton_exit(void)
{
platform_driver_unregister(&twl6030_pwrbutton_driver);
}
module_exit(twl6030_pwrbutton_exit);
MODULE_ALIAS("platform:twl6030_pwrbutton");
MODULE_DESCRIPTION("Triton2 Power Button");
MODULE_LICENSE("GPL");
MODULE_AUTHOR("Dan Murphy <DMurphy@ti.com>");
|
