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
|
// SPDX-License-Identifier: GPL-2.0-only
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/platform_device.h>
#include <linux/regmap.h>
#include <linux/mfd/88pm886.h>
struct pm886_onkey {
struct input_dev *idev;
struct pm886_chip *chip;
};
static irqreturn_t pm886_onkey_irq_handler(int irq, void *data)
{
struct pm886_onkey *onkey = data;
struct regmap *regmap = onkey->chip->regmap;
struct input_dev *idev = onkey->idev;
struct device *parent = idev->dev.parent;
unsigned int val;
int err;
err = regmap_read(regmap, PM886_REG_STATUS1, &val);
if (err) {
dev_err(parent, "Failed to read status: %d\n", err);
return IRQ_NONE;
}
val &= PM886_ONKEY_STS1;
input_report_key(idev, KEY_POWER, val);
input_sync(idev);
return IRQ_HANDLED;
}
static int pm886_onkey_probe(struct platform_device *pdev)
{
struct pm886_chip *chip = dev_get_drvdata(pdev->dev.parent);
struct device *dev = &pdev->dev;
struct pm886_onkey *onkey;
struct input_dev *idev;
int irq, err;
onkey = devm_kzalloc(dev, sizeof(*onkey), GFP_KERNEL);
if (!onkey)
return -ENOMEM;
onkey->chip = chip;
irq = platform_get_irq(pdev, 0);
if (irq < 0)
return dev_err_probe(dev, irq, "Failed to get IRQ\n");
idev = devm_input_allocate_device(dev);
if (!idev) {
dev_err(dev, "Failed to allocate input device\n");
return -ENOMEM;
}
onkey->idev = idev;
idev->name = "88pm886-onkey";
idev->phys = "88pm886-onkey/input0";
idev->id.bustype = BUS_I2C;
input_set_capability(idev, EV_KEY, KEY_POWER);
err = devm_request_threaded_irq(dev, irq, NULL, pm886_onkey_irq_handler,
IRQF_ONESHOT | IRQF_NO_SUSPEND, "onkey",
onkey);
if (err)
return dev_err_probe(dev, err, "Failed to request IRQ\n");
err = input_register_device(idev);
if (err)
return dev_err_probe(dev, err, "Failed to register input device\n");
return 0;
}
static const struct platform_device_id pm886_onkey_id_table[] = {
{ "88pm886-onkey", },
{ }
};
MODULE_DEVICE_TABLE(platform, pm886_onkey_id_table);
static struct platform_driver pm886_onkey_driver = {
.driver = {
.name = "88pm886-onkey",
},
.probe = pm886_onkey_probe,
.id_table = pm886_onkey_id_table,
};
module_platform_driver(pm886_onkey_driver);
MODULE_DESCRIPTION("Marvell 88PM886 onkey driver");
MODULE_AUTHOR("Karel Balej <balejk@matfyz.cz>");
MODULE_LICENSE("GPL");
|
