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
|
#include <linux/module.h>
#include <linux/init.h>
#include <linux/input.h>
#include <linux/platform_device.h>
#include <linux/mfd/da9052/da9052.h>
#include <linux/mfd/da9052/reg.h>
#define DRIVER_NAME "da9052-onkey"
struct da9052_onkey_data {
struct da9052 *da9052;
struct da9052_eh_nb eh_data;
struct input_dev *input;
};
static void da9052_onkey_report_event(struct da9052_eh_nb *eh_data,
unsigned int event)
{
struct da9052_onkey_data *da9052_onkey =
container_of(eh_data, struct da9052_onkey_data, eh_data);
struct da9052_ssc_msg msg;
unsigned int ret;
/* Read the Evnet Register */
msg.addr = DA9052_EVENTB_REG;
da9052_lock(da9052_onkey->da9052);
ret = da9052_onkey->da9052->read(da9052_onkey->da9052, &msg);
if (ret) {
da9052_unlock(da9052_onkey->da9052);
return;
}
da9052_unlock(da9052_onkey->da9052);
msg.data = msg.data & DA9052_EVENTB_ENONKEY;
input_report_key(da9052_onkey->input, KEY_POWER, msg.data);
input_sync(da9052_onkey->input);
printk(KERN_INFO "DA9052 ONKEY EVENT REPORTED\n");
}
static int __devinit da9052_onkey_probe(struct platform_device *pdev)
{
struct da9052_onkey_data *da9052_onkey;
int error;
da9052_onkey = kzalloc(sizeof(*da9052_onkey), GFP_KERNEL);
da9052_onkey->input = input_allocate_device();
if (!da9052_onkey->input) {
dev_err(&pdev->dev, "failed to allocate data device\n");
error = -ENOMEM;
goto fail1;
}
da9052_onkey->da9052 = dev_get_drvdata(pdev->dev.parent);
if (!da9052_onkey->input) {
dev_err(&pdev->dev, "failed to allocate input device\n");
error = -ENOMEM;
goto fail2;
}
da9052_onkey->input->evbit[0] = BIT_MASK(EV_KEY);
da9052_onkey->input->keybit[BIT_WORD(KEY_POWER)] = BIT_MASK(KEY_POWER);
da9052_onkey->input->name = "da9052-onkey";
da9052_onkey->input->phys = "da9052-onkey/input0";
da9052_onkey->input->dev.parent = &pdev->dev;
/* Set the EH structure */
da9052_onkey->eh_data.eve_type = ONKEY_EVE;
da9052_onkey->eh_data.call_back = &da9052_onkey_report_event;
error = da9052_onkey->da9052->register_event_notifier(
da9052_onkey->da9052,
&da9052_onkey->eh_data);
if (error)
goto fail2;
error = input_register_device(da9052_onkey->input);
if (error) {
dev_err(&pdev->dev, "Unable to register input "
"device,error: %d\n", error);
goto fail3;
}
platform_set_drvdata(pdev, da9052_onkey);
return 0;
fail3:
da9052_onkey->da9052->unregister_event_notifier(da9052_onkey->da9052,
&da9052_onkey->eh_data);
fail2:
input_free_device(da9052_onkey->input);
fail1:
kfree(da9052_onkey);
return error;
}
static int __devexit da9052_onkey_remove(struct platform_device *pdev)
{
struct da9052_onkey_data *da9052_onkey = pdev->dev.platform_data;
da9052_onkey->da9052->unregister_event_notifier(da9052_onkey->da9052,
&da9052_onkey->eh_data);
input_unregister_device(da9052_onkey->input);
kfree(da9052_onkey);
return 0;
}
static struct platform_driver da9052_onkey_driver = {
.probe = da9052_onkey_probe,
.remove = __devexit_p(da9052_onkey_remove),
.driver = {
.name = "da9052-onkey",
.owner = THIS_MODULE,
}
};
static int __init da9052_onkey_init(void)
{
return platform_driver_register(&da9052_onkey_driver);
}
static void __exit da9052_onkey_exit(void)
{
platform_driver_unregister(&da9052_onkey_driver);
}
module_init(da9052_onkey_init);
module_exit(da9052_onkey_exit);
MODULE_LICENSE("GPL");
MODULE_AUTHOR("David Dajun Chen <dchen@diasemi.com>");
MODULE_DESCRIPTION("Onkey driver for DA9052");
MODULE_ALIAS("platform:" DRIVER_NAME);
|
