162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright (C) 2022 Richtek Technology Corp. 462306a36Sopenharmony_ci * Author: ChiYuan Huang <cy_huang@richtek.com> 562306a36Sopenharmony_ci */ 662306a36Sopenharmony_ci 762306a36Sopenharmony_ci#include <linux/bits.h> 862306a36Sopenharmony_ci#include <linux/input.h> 962306a36Sopenharmony_ci#include <linux/interrupt.h> 1062306a36Sopenharmony_ci#include <linux/kernel.h> 1162306a36Sopenharmony_ci#include <linux/module.h> 1262306a36Sopenharmony_ci#include <linux/mod_devicetable.h> 1362306a36Sopenharmony_ci#include <linux/platform_device.h> 1462306a36Sopenharmony_ci#include <linux/regmap.h> 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci#define RT5120_REG_INTSTAT 0x1E 1762306a36Sopenharmony_ci#define RT5120_PWRKEYSTAT_MASK BIT(7) 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_cistruct rt5120_priv { 2062306a36Sopenharmony_ci struct regmap *regmap; 2162306a36Sopenharmony_ci struct input_dev *input; 2262306a36Sopenharmony_ci}; 2362306a36Sopenharmony_ci 2462306a36Sopenharmony_cistatic irqreturn_t rt5120_pwrkey_handler(int irq, void *devid) 2562306a36Sopenharmony_ci{ 2662306a36Sopenharmony_ci struct rt5120_priv *priv = devid; 2762306a36Sopenharmony_ci unsigned int stat; 2862306a36Sopenharmony_ci int error; 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_ci error = regmap_read(priv->regmap, RT5120_REG_INTSTAT, &stat); 3162306a36Sopenharmony_ci if (error) 3262306a36Sopenharmony_ci return IRQ_NONE; 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_ci input_report_key(priv->input, KEY_POWER, 3562306a36Sopenharmony_ci !(stat & RT5120_PWRKEYSTAT_MASK)); 3662306a36Sopenharmony_ci input_sync(priv->input); 3762306a36Sopenharmony_ci 3862306a36Sopenharmony_ci return IRQ_HANDLED; 3962306a36Sopenharmony_ci} 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_cistatic int rt5120_pwrkey_probe(struct platform_device *pdev) 4262306a36Sopenharmony_ci{ 4362306a36Sopenharmony_ci struct rt5120_priv *priv; 4462306a36Sopenharmony_ci struct device *dev = &pdev->dev; 4562306a36Sopenharmony_ci int press_irq, release_irq; 4662306a36Sopenharmony_ci int error; 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); 4962306a36Sopenharmony_ci if (!priv) 5062306a36Sopenharmony_ci return -ENOMEM; 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_ci priv->regmap = dev_get_regmap(dev->parent, NULL); 5362306a36Sopenharmony_ci if (!priv->regmap) { 5462306a36Sopenharmony_ci dev_err(dev, "Failed to init regmap\n"); 5562306a36Sopenharmony_ci return -ENODEV; 5662306a36Sopenharmony_ci } 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_ci press_irq = platform_get_irq_byname(pdev, "pwrkey-press"); 5962306a36Sopenharmony_ci if (press_irq < 0) 6062306a36Sopenharmony_ci return press_irq; 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_ci release_irq = platform_get_irq_byname(pdev, "pwrkey-release"); 6362306a36Sopenharmony_ci if (release_irq < 0) 6462306a36Sopenharmony_ci return release_irq; 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_ci /* Make input device be device resource managed */ 6762306a36Sopenharmony_ci priv->input = devm_input_allocate_device(dev); 6862306a36Sopenharmony_ci if (!priv->input) 6962306a36Sopenharmony_ci return -ENOMEM; 7062306a36Sopenharmony_ci 7162306a36Sopenharmony_ci priv->input->name = "rt5120_pwrkey"; 7262306a36Sopenharmony_ci priv->input->phys = "rt5120_pwrkey/input0"; 7362306a36Sopenharmony_ci priv->input->id.bustype = BUS_I2C; 7462306a36Sopenharmony_ci input_set_capability(priv->input, EV_KEY, KEY_POWER); 7562306a36Sopenharmony_ci 7662306a36Sopenharmony_ci error = input_register_device(priv->input); 7762306a36Sopenharmony_ci if (error) { 7862306a36Sopenharmony_ci dev_err(dev, "Failed to register input device: %d\n", error); 7962306a36Sopenharmony_ci return error; 8062306a36Sopenharmony_ci } 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_ci error = devm_request_threaded_irq(dev, press_irq, 8362306a36Sopenharmony_ci NULL, rt5120_pwrkey_handler, 8462306a36Sopenharmony_ci 0, "pwrkey-press", priv); 8562306a36Sopenharmony_ci if (error) { 8662306a36Sopenharmony_ci dev_err(dev, 8762306a36Sopenharmony_ci "Failed to register pwrkey press irq: %d\n", error); 8862306a36Sopenharmony_ci return error; 8962306a36Sopenharmony_ci } 9062306a36Sopenharmony_ci 9162306a36Sopenharmony_ci error = devm_request_threaded_irq(dev, release_irq, 9262306a36Sopenharmony_ci NULL, rt5120_pwrkey_handler, 9362306a36Sopenharmony_ci 0, "pwrkey-release", priv); 9462306a36Sopenharmony_ci if (error) { 9562306a36Sopenharmony_ci dev_err(dev, 9662306a36Sopenharmony_ci "Failed to register pwrkey release irq: %d\n", error); 9762306a36Sopenharmony_ci return error; 9862306a36Sopenharmony_ci } 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_ci return 0; 10162306a36Sopenharmony_ci} 10262306a36Sopenharmony_ci 10362306a36Sopenharmony_cistatic const struct of_device_id r5120_pwrkey_match_table[] = { 10462306a36Sopenharmony_ci { .compatible = "richtek,rt5120-pwrkey" }, 10562306a36Sopenharmony_ci {} 10662306a36Sopenharmony_ci}; 10762306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, r5120_pwrkey_match_table); 10862306a36Sopenharmony_ci 10962306a36Sopenharmony_cistatic struct platform_driver rt5120_pwrkey_driver = { 11062306a36Sopenharmony_ci .driver = { 11162306a36Sopenharmony_ci .name = "rt5120-pwrkey", 11262306a36Sopenharmony_ci .of_match_table = r5120_pwrkey_match_table, 11362306a36Sopenharmony_ci }, 11462306a36Sopenharmony_ci .probe = rt5120_pwrkey_probe, 11562306a36Sopenharmony_ci}; 11662306a36Sopenharmony_cimodule_platform_driver(rt5120_pwrkey_driver); 11762306a36Sopenharmony_ci 11862306a36Sopenharmony_ciMODULE_AUTHOR("ChiYuan Huang <cy_huang@richtek.com>"); 11962306a36Sopenharmony_ciMODULE_DESCRIPTION("Richtek RT5120 power key driver"); 12062306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 121