1*ed3d5bd2SChiYuan Huang // SPDX-License-Identifier: GPL-2.0-only
2*ed3d5bd2SChiYuan Huang /*
3*ed3d5bd2SChiYuan Huang * Copyright (C) 2022 Richtek Technology Corp.
4*ed3d5bd2SChiYuan Huang * Author: ChiYuan Huang <cy_huang@richtek.com>
5*ed3d5bd2SChiYuan Huang */
6*ed3d5bd2SChiYuan Huang
7*ed3d5bd2SChiYuan Huang #include <linux/bits.h>
8*ed3d5bd2SChiYuan Huang #include <linux/input.h>
9*ed3d5bd2SChiYuan Huang #include <linux/interrupt.h>
10*ed3d5bd2SChiYuan Huang #include <linux/kernel.h>
11*ed3d5bd2SChiYuan Huang #include <linux/module.h>
12*ed3d5bd2SChiYuan Huang #include <linux/mod_devicetable.h>
13*ed3d5bd2SChiYuan Huang #include <linux/platform_device.h>
14*ed3d5bd2SChiYuan Huang #include <linux/regmap.h>
15*ed3d5bd2SChiYuan Huang
16*ed3d5bd2SChiYuan Huang #define RT5120_REG_INTSTAT 0x1E
17*ed3d5bd2SChiYuan Huang #define RT5120_PWRKEYSTAT_MASK BIT(7)
18*ed3d5bd2SChiYuan Huang
19*ed3d5bd2SChiYuan Huang struct rt5120_priv {
20*ed3d5bd2SChiYuan Huang struct regmap *regmap;
21*ed3d5bd2SChiYuan Huang struct input_dev *input;
22*ed3d5bd2SChiYuan Huang };
23*ed3d5bd2SChiYuan Huang
rt5120_pwrkey_handler(int irq,void * devid)24*ed3d5bd2SChiYuan Huang static irqreturn_t rt5120_pwrkey_handler(int irq, void *devid)
25*ed3d5bd2SChiYuan Huang {
26*ed3d5bd2SChiYuan Huang struct rt5120_priv *priv = devid;
27*ed3d5bd2SChiYuan Huang unsigned int stat;
28*ed3d5bd2SChiYuan Huang int error;
29*ed3d5bd2SChiYuan Huang
30*ed3d5bd2SChiYuan Huang error = regmap_read(priv->regmap, RT5120_REG_INTSTAT, &stat);
31*ed3d5bd2SChiYuan Huang if (error)
32*ed3d5bd2SChiYuan Huang return IRQ_NONE;
33*ed3d5bd2SChiYuan Huang
34*ed3d5bd2SChiYuan Huang input_report_key(priv->input, KEY_POWER,
35*ed3d5bd2SChiYuan Huang !(stat & RT5120_PWRKEYSTAT_MASK));
36*ed3d5bd2SChiYuan Huang input_sync(priv->input);
37*ed3d5bd2SChiYuan Huang
38*ed3d5bd2SChiYuan Huang return IRQ_HANDLED;
39*ed3d5bd2SChiYuan Huang }
40*ed3d5bd2SChiYuan Huang
rt5120_pwrkey_probe(struct platform_device * pdev)41*ed3d5bd2SChiYuan Huang static int rt5120_pwrkey_probe(struct platform_device *pdev)
42*ed3d5bd2SChiYuan Huang {
43*ed3d5bd2SChiYuan Huang struct rt5120_priv *priv;
44*ed3d5bd2SChiYuan Huang struct device *dev = &pdev->dev;
45*ed3d5bd2SChiYuan Huang int press_irq, release_irq;
46*ed3d5bd2SChiYuan Huang int error;
47*ed3d5bd2SChiYuan Huang
48*ed3d5bd2SChiYuan Huang priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
49*ed3d5bd2SChiYuan Huang if (!priv)
50*ed3d5bd2SChiYuan Huang return -ENOMEM;
51*ed3d5bd2SChiYuan Huang
52*ed3d5bd2SChiYuan Huang priv->regmap = dev_get_regmap(dev->parent, NULL);
53*ed3d5bd2SChiYuan Huang if (!priv->regmap) {
54*ed3d5bd2SChiYuan Huang dev_err(dev, "Failed to init regmap\n");
55*ed3d5bd2SChiYuan Huang return -ENODEV;
56*ed3d5bd2SChiYuan Huang }
57*ed3d5bd2SChiYuan Huang
58*ed3d5bd2SChiYuan Huang press_irq = platform_get_irq_byname(pdev, "pwrkey-press");
59*ed3d5bd2SChiYuan Huang if (press_irq < 0)
60*ed3d5bd2SChiYuan Huang return press_irq;
61*ed3d5bd2SChiYuan Huang
62*ed3d5bd2SChiYuan Huang release_irq = platform_get_irq_byname(pdev, "pwrkey-release");
63*ed3d5bd2SChiYuan Huang if (release_irq < 0)
64*ed3d5bd2SChiYuan Huang return release_irq;
65*ed3d5bd2SChiYuan Huang
66*ed3d5bd2SChiYuan Huang /* Make input device be device resource managed */
67*ed3d5bd2SChiYuan Huang priv->input = devm_input_allocate_device(dev);
68*ed3d5bd2SChiYuan Huang if (!priv->input)
69*ed3d5bd2SChiYuan Huang return -ENOMEM;
70*ed3d5bd2SChiYuan Huang
71*ed3d5bd2SChiYuan Huang priv->input->name = "rt5120_pwrkey";
72*ed3d5bd2SChiYuan Huang priv->input->phys = "rt5120_pwrkey/input0";
73*ed3d5bd2SChiYuan Huang priv->input->id.bustype = BUS_I2C;
74*ed3d5bd2SChiYuan Huang input_set_capability(priv->input, EV_KEY, KEY_POWER);
75*ed3d5bd2SChiYuan Huang
76*ed3d5bd2SChiYuan Huang error = input_register_device(priv->input);
77*ed3d5bd2SChiYuan Huang if (error) {
78*ed3d5bd2SChiYuan Huang dev_err(dev, "Failed to register input device: %d\n", error);
79*ed3d5bd2SChiYuan Huang return error;
80*ed3d5bd2SChiYuan Huang }
81*ed3d5bd2SChiYuan Huang
82*ed3d5bd2SChiYuan Huang error = devm_request_threaded_irq(dev, press_irq,
83*ed3d5bd2SChiYuan Huang NULL, rt5120_pwrkey_handler,
84*ed3d5bd2SChiYuan Huang 0, "pwrkey-press", priv);
85*ed3d5bd2SChiYuan Huang if (error) {
86*ed3d5bd2SChiYuan Huang dev_err(dev,
87*ed3d5bd2SChiYuan Huang "Failed to register pwrkey press irq: %d\n", error);
88*ed3d5bd2SChiYuan Huang return error;
89*ed3d5bd2SChiYuan Huang }
90*ed3d5bd2SChiYuan Huang
91*ed3d5bd2SChiYuan Huang error = devm_request_threaded_irq(dev, release_irq,
92*ed3d5bd2SChiYuan Huang NULL, rt5120_pwrkey_handler,
93*ed3d5bd2SChiYuan Huang 0, "pwrkey-release", priv);
94*ed3d5bd2SChiYuan Huang if (error) {
95*ed3d5bd2SChiYuan Huang dev_err(dev,
96*ed3d5bd2SChiYuan Huang "Failed to register pwrkey release irq: %d\n", error);
97*ed3d5bd2SChiYuan Huang return error;
98*ed3d5bd2SChiYuan Huang }
99*ed3d5bd2SChiYuan Huang
100*ed3d5bd2SChiYuan Huang return 0;
101*ed3d5bd2SChiYuan Huang }
102*ed3d5bd2SChiYuan Huang
103*ed3d5bd2SChiYuan Huang static const struct of_device_id r5120_pwrkey_match_table[] = {
104*ed3d5bd2SChiYuan Huang { .compatible = "richtek,rt5120-pwrkey" },
105*ed3d5bd2SChiYuan Huang {}
106*ed3d5bd2SChiYuan Huang };
107*ed3d5bd2SChiYuan Huang MODULE_DEVICE_TABLE(of, r5120_pwrkey_match_table);
108*ed3d5bd2SChiYuan Huang
109*ed3d5bd2SChiYuan Huang static struct platform_driver rt5120_pwrkey_driver = {
110*ed3d5bd2SChiYuan Huang .driver = {
111*ed3d5bd2SChiYuan Huang .name = "rt5120-pwrkey",
112*ed3d5bd2SChiYuan Huang .of_match_table = r5120_pwrkey_match_table,
113*ed3d5bd2SChiYuan Huang },
114*ed3d5bd2SChiYuan Huang .probe = rt5120_pwrkey_probe,
115*ed3d5bd2SChiYuan Huang };
116*ed3d5bd2SChiYuan Huang module_platform_driver(rt5120_pwrkey_driver);
117*ed3d5bd2SChiYuan Huang
118*ed3d5bd2SChiYuan Huang MODULE_AUTHOR("ChiYuan Huang <cy_huang@richtek.com>");
119*ed3d5bd2SChiYuan Huang MODULE_DESCRIPTION("Richtek RT5120 power key driver");
120*ed3d5bd2SChiYuan Huang MODULE_LICENSE("GPL");
121