mirror of
https://github.com/torvalds/linux.git
synced 2024-12-25 04:11:49 +00:00
072a785233
Now that we have proper managed API to create device attributes, let's use it instead of installing a custom devm action. Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com> Reviewed-by: Guenter Roeck <linux@roeck-us.net> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
330 lines
8.2 KiB
C
330 lines
8.2 KiB
C
/*
|
|
* axp20x power button driver.
|
|
*
|
|
* Copyright (C) 2013 Carlo Caione <carlo@caione.org>
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include <linux/acpi.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/init.h>
|
|
#include <linux/input.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/mfd/axp20x.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/slab.h>
|
|
|
|
#define AXP20X_PEK_STARTUP_MASK (0xc0)
|
|
#define AXP20X_PEK_SHUTDOWN_MASK (0x03)
|
|
|
|
struct axp20x_pek {
|
|
struct axp20x_dev *axp20x;
|
|
struct input_dev *input;
|
|
int irq_dbr;
|
|
int irq_dbf;
|
|
};
|
|
|
|
struct axp20x_time {
|
|
unsigned int time;
|
|
unsigned int idx;
|
|
};
|
|
|
|
static const struct axp20x_time startup_time[] = {
|
|
{ .time = 128, .idx = 0 },
|
|
{ .time = 1000, .idx = 2 },
|
|
{ .time = 3000, .idx = 1 },
|
|
{ .time = 2000, .idx = 3 },
|
|
};
|
|
|
|
static const struct axp20x_time shutdown_time[] = {
|
|
{ .time = 4000, .idx = 0 },
|
|
{ .time = 6000, .idx = 1 },
|
|
{ .time = 8000, .idx = 2 },
|
|
{ .time = 10000, .idx = 3 },
|
|
};
|
|
|
|
struct axp20x_pek_ext_attr {
|
|
const struct axp20x_time *p_time;
|
|
unsigned int mask;
|
|
};
|
|
|
|
static struct axp20x_pek_ext_attr axp20x_pek_startup_ext_attr = {
|
|
.p_time = startup_time,
|
|
.mask = AXP20X_PEK_STARTUP_MASK,
|
|
};
|
|
|
|
static struct axp20x_pek_ext_attr axp20x_pek_shutdown_ext_attr = {
|
|
.p_time = shutdown_time,
|
|
.mask = AXP20X_PEK_SHUTDOWN_MASK,
|
|
};
|
|
|
|
static struct axp20x_pek_ext_attr *get_axp_ext_attr(struct device_attribute *attr)
|
|
{
|
|
return container_of(attr, struct dev_ext_attribute, attr)->var;
|
|
}
|
|
|
|
static ssize_t axp20x_show_ext_attr(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
|
|
struct axp20x_pek_ext_attr *axp20x_ea = get_axp_ext_attr(attr);
|
|
unsigned int val;
|
|
int ret, i;
|
|
|
|
ret = regmap_read(axp20x_pek->axp20x->regmap, AXP20X_PEK_KEY, &val);
|
|
if (ret != 0)
|
|
return ret;
|
|
|
|
val &= axp20x_ea->mask;
|
|
val >>= ffs(axp20x_ea->mask) - 1;
|
|
|
|
for (i = 0; i < 4; i++)
|
|
if (val == axp20x_ea->p_time[i].idx)
|
|
val = axp20x_ea->p_time[i].time;
|
|
|
|
return sprintf(buf, "%u\n", val);
|
|
}
|
|
|
|
static ssize_t axp20x_store_ext_attr(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
|
|
struct axp20x_pek_ext_attr *axp20x_ea = get_axp_ext_attr(attr);
|
|
char val_str[20];
|
|
size_t len;
|
|
int ret, i;
|
|
unsigned int val, idx = 0;
|
|
unsigned int best_err = UINT_MAX;
|
|
|
|
val_str[sizeof(val_str) - 1] = '\0';
|
|
strncpy(val_str, buf, sizeof(val_str) - 1);
|
|
len = strlen(val_str);
|
|
|
|
if (len && val_str[len - 1] == '\n')
|
|
val_str[len - 1] = '\0';
|
|
|
|
ret = kstrtouint(val_str, 10, &val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
for (i = 3; i >= 0; i--) {
|
|
unsigned int err;
|
|
|
|
err = abs(axp20x_ea->p_time[i].time - val);
|
|
if (err < best_err) {
|
|
best_err = err;
|
|
idx = axp20x_ea->p_time[i].idx;
|
|
}
|
|
|
|
if (!err)
|
|
break;
|
|
}
|
|
|
|
idx <<= ffs(axp20x_ea->mask) - 1;
|
|
ret = regmap_update_bits(axp20x_pek->axp20x->regmap,
|
|
AXP20X_PEK_KEY,
|
|
axp20x_ea->mask, idx);
|
|
if (ret != 0)
|
|
return -EINVAL;
|
|
|
|
return count;
|
|
}
|
|
|
|
static struct dev_ext_attribute axp20x_dev_attr_startup = {
|
|
.attr = __ATTR(startup, 0644, axp20x_show_ext_attr, axp20x_store_ext_attr),
|
|
.var = &axp20x_pek_startup_ext_attr,
|
|
};
|
|
|
|
static struct dev_ext_attribute axp20x_dev_attr_shutdown = {
|
|
.attr = __ATTR(shutdown, 0644, axp20x_show_ext_attr, axp20x_store_ext_attr),
|
|
.var = &axp20x_pek_shutdown_ext_attr,
|
|
};
|
|
|
|
static struct attribute *axp20x_attributes[] = {
|
|
&axp20x_dev_attr_startup.attr.attr,
|
|
&axp20x_dev_attr_shutdown.attr.attr,
|
|
NULL,
|
|
};
|
|
|
|
static const struct attribute_group axp20x_attribute_group = {
|
|
.attrs = axp20x_attributes,
|
|
};
|
|
|
|
static irqreturn_t axp20x_pek_irq(int irq, void *pwr)
|
|
{
|
|
struct input_dev *idev = pwr;
|
|
struct axp20x_pek *axp20x_pek = input_get_drvdata(idev);
|
|
|
|
/*
|
|
* The power-button is connected to ground so a falling edge (dbf)
|
|
* means it is pressed.
|
|
*/
|
|
if (irq == axp20x_pek->irq_dbf)
|
|
input_report_key(idev, KEY_POWER, true);
|
|
else if (irq == axp20x_pek->irq_dbr)
|
|
input_report_key(idev, KEY_POWER, false);
|
|
|
|
input_sync(idev);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static int axp20x_pek_probe_input_device(struct axp20x_pek *axp20x_pek,
|
|
struct platform_device *pdev)
|
|
{
|
|
struct axp20x_dev *axp20x = axp20x_pek->axp20x;
|
|
struct input_dev *idev;
|
|
int error;
|
|
|
|
axp20x_pek->irq_dbr = platform_get_irq_byname(pdev, "PEK_DBR");
|
|
if (axp20x_pek->irq_dbr < 0) {
|
|
dev_err(&pdev->dev, "No IRQ for PEK_DBR, error=%d\n",
|
|
axp20x_pek->irq_dbr);
|
|
return axp20x_pek->irq_dbr;
|
|
}
|
|
axp20x_pek->irq_dbr = regmap_irq_get_virq(axp20x->regmap_irqc,
|
|
axp20x_pek->irq_dbr);
|
|
|
|
axp20x_pek->irq_dbf = platform_get_irq_byname(pdev, "PEK_DBF");
|
|
if (axp20x_pek->irq_dbf < 0) {
|
|
dev_err(&pdev->dev, "No IRQ for PEK_DBF, error=%d\n",
|
|
axp20x_pek->irq_dbf);
|
|
return axp20x_pek->irq_dbf;
|
|
}
|
|
axp20x_pek->irq_dbf = regmap_irq_get_virq(axp20x->regmap_irqc,
|
|
axp20x_pek->irq_dbf);
|
|
|
|
axp20x_pek->input = devm_input_allocate_device(&pdev->dev);
|
|
if (!axp20x_pek->input)
|
|
return -ENOMEM;
|
|
|
|
idev = axp20x_pek->input;
|
|
|
|
idev->name = "axp20x-pek";
|
|
idev->phys = "m1kbd/input2";
|
|
idev->dev.parent = &pdev->dev;
|
|
|
|
input_set_capability(idev, EV_KEY, KEY_POWER);
|
|
|
|
input_set_drvdata(idev, axp20x_pek);
|
|
|
|
error = devm_request_any_context_irq(&pdev->dev, axp20x_pek->irq_dbr,
|
|
axp20x_pek_irq, 0,
|
|
"axp20x-pek-dbr", idev);
|
|
if (error < 0) {
|
|
dev_err(&pdev->dev, "Failed to request dbr IRQ#%d: %d\n",
|
|
axp20x_pek->irq_dbr, error);
|
|
return error;
|
|
}
|
|
|
|
error = devm_request_any_context_irq(&pdev->dev, axp20x_pek->irq_dbf,
|
|
axp20x_pek_irq, 0,
|
|
"axp20x-pek-dbf", idev);
|
|
if (error < 0) {
|
|
dev_err(&pdev->dev, "Failed to request dbf IRQ#%d: %d\n",
|
|
axp20x_pek->irq_dbf, error);
|
|
return error;
|
|
}
|
|
|
|
error = input_register_device(idev);
|
|
if (error) {
|
|
dev_err(&pdev->dev, "Can't register input device: %d\n",
|
|
error);
|
|
return error;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_ACPI
|
|
static bool axp20x_pek_should_register_input(struct axp20x_pek *axp20x_pek,
|
|
struct platform_device *pdev)
|
|
{
|
|
unsigned long long hrv = 0;
|
|
acpi_status status;
|
|
|
|
if (IS_ENABLED(CONFIG_INPUT_SOC_BUTTON_ARRAY) &&
|
|
axp20x_pek->axp20x->variant == AXP288_ID) {
|
|
status = acpi_evaluate_integer(ACPI_HANDLE(pdev->dev.parent),
|
|
"_HRV", NULL, &hrv);
|
|
if (ACPI_FAILURE(status))
|
|
dev_err(&pdev->dev, "Failed to get PMIC hardware revision\n");
|
|
|
|
/*
|
|
* On Cherry Trail platforms (hrv == 3), do not register the
|
|
* input device if there is an "INTCFD9" or "ACPI0011" gpio
|
|
* button ACPI device, as that handles the power button too,
|
|
* and otherwise we end up reporting all presses twice.
|
|
*/
|
|
if (hrv == 3 && (acpi_dev_present("INTCFD9", NULL, -1) ||
|
|
acpi_dev_present("ACPI0011", NULL, -1)))
|
|
return false;
|
|
|
|
}
|
|
|
|
return true;
|
|
}
|
|
#else
|
|
static bool axp20x_pek_should_register_input(struct axp20x_pek *axp20x_pek,
|
|
struct platform_device *pdev)
|
|
{
|
|
return true;
|
|
}
|
|
#endif
|
|
|
|
static int axp20x_pek_probe(struct platform_device *pdev)
|
|
{
|
|
struct axp20x_pek *axp20x_pek;
|
|
int error;
|
|
|
|
axp20x_pek = devm_kzalloc(&pdev->dev, sizeof(struct axp20x_pek),
|
|
GFP_KERNEL);
|
|
if (!axp20x_pek)
|
|
return -ENOMEM;
|
|
|
|
axp20x_pek->axp20x = dev_get_drvdata(pdev->dev.parent);
|
|
|
|
if (axp20x_pek_should_register_input(axp20x_pek, pdev)) {
|
|
error = axp20x_pek_probe_input_device(axp20x_pek, pdev);
|
|
if (error)
|
|
return error;
|
|
}
|
|
|
|
error = devm_device_add_group(&pdev->dev, &axp20x_attribute_group);
|
|
if (error) {
|
|
dev_err(&pdev->dev, "Failed to create sysfs attributes: %d\n",
|
|
error);
|
|
return error;
|
|
}
|
|
|
|
platform_set_drvdata(pdev, axp20x_pek);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver axp20x_pek_driver = {
|
|
.probe = axp20x_pek_probe,
|
|
.driver = {
|
|
.name = "axp20x-pek",
|
|
},
|
|
};
|
|
module_platform_driver(axp20x_pek_driver);
|
|
|
|
MODULE_DESCRIPTION("axp20x Power Button");
|
|
MODULE_AUTHOR("Carlo Caione <carlo@caione.org>");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_ALIAS("platform:axp20x-pek");
|