[linux-2.6-block.git] / drivers / input / misc / axp20x-pek.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 void axp20x_remove_sysfs_group(void *_data)
{
	struct device *dev = _data;

	sysfs_remove_group(&dev->kobj, &axp20x_attribute_group);
}

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;
}

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);

	/*
	 * Do not register the input device if there is an "INTCFD9"
	 * gpio button ACPI device, that handles the power button too,
	 * and otherwise we end up reporting all presses twice.
	 */
	if (!acpi_dev_found("INTCFD9") ||
	    !IS_ENABLED(CONFIG_INPUT_SOC_BUTTON_ARRAY)) {
		error = axp20x_pek_probe_input_device(axp20x_pek, pdev);
		if (error)
			return error;
	}

	error = sysfs_create_group(&pdev->dev.kobj, &axp20x_attribute_group);
	if (error) {
		dev_err(&pdev->dev, "Failed to create sysfs attributes: %d\n",
			error);
		return error;
	}

	error = devm_add_action(&pdev->dev,
				axp20x_remove_sysfs_group, &pdev->dev);
	if (error) {
		axp20x_remove_sysfs_group(&pdev->dev);
		dev_err(&pdev->dev, "Failed to add sysfs cleanup action: %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");
Commit	Line	Data
5b6c26a9 CC	1	/*
	2	* axp20x power button driver.
	3	*
	4	* Copyright (C) 2013 Carlo Caione <carlo@caione.org>
	5	*
	6	* This file is subject to the terms and conditions of the GNU General
	7	* Public License. See the file "COPYING" in the main directory of this
	8	* archive for more details.
	9	*
	10	* This program is distributed in the hope that it will be useful,
	11	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	12	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	13	* GNU General Public License for more details.
	14	*/
	15
9b13a4ca	16	#include <linux/acpi.h>
5b6c26a9 CC	17	#include <linux/errno.h>
	18	#include <linux/irq.h>
	19	#include <linux/init.h>
	20	#include <linux/input.h>
	21	#include <linux/interrupt.h>
	22	#include <linux/kernel.h>
	23	#include <linux/mfd/axp20x.h>
	24	#include <linux/module.h>
	25	#include <linux/platform_device.h>
	26	#include <linux/regmap.h>
	27	#include <linux/slab.h>
	28
	29	#define AXP20X_PEK_STARTUP_MASK (0xc0)
	30	#define AXP20X_PEK_SHUTDOWN_MASK (0x03)
	31
	32	struct axp20x_pek {
	33	struct axp20x_dev *axp20x;
	34	struct input_dev *input;
	35	int irq_dbr;
	36	int irq_dbf;
	37	};
	38
	39	struct axp20x_time {
	40	unsigned int time;
	41	unsigned int idx;
	42	};
	43
	44	static const struct axp20x_time startup_time[] = {
	45	{ .time = 128, .idx = 0 },
	46	{ .time = 1000, .idx = 2 },
	47	{ .time = 3000, .idx = 1 },
	48	{ .time = 2000, .idx = 3 },
	49	};
	50
	51	static const struct axp20x_time shutdown_time[] = {
	52	{ .time = 4000, .idx = 0 },
	53	{ .time = 6000, .idx = 1 },
	54	{ .time = 8000, .idx = 2 },
	55	{ .time = 10000, .idx = 3 },
	56	};
	57
	58	struct axp20x_pek_ext_attr {
	59	const struct axp20x_time *p_time;
	60	unsigned int mask;
	61	};
	62
	63	static struct axp20x_pek_ext_attr axp20x_pek_startup_ext_attr = {
	64	.p_time = startup_time,
	65	.mask = AXP20X_PEK_STARTUP_MASK,
	66	};
	67
	68	static struct axp20x_pek_ext_attr axp20x_pek_shutdown_ext_attr = {
	69	.p_time = shutdown_time,
	70	.mask = AXP20X_PEK_SHUTDOWN_MASK,
	71	};
	72
	73	static struct axp20x_pek_ext_attr get_axp_ext_attr(struct device_attribute attr)
	74	{
	75	return container_of(attr, struct dev_ext_attribute, attr)->var;
	76	}
	77
	78	static ssize_t axp20x_show_ext_attr(struct device *dev,
	79	struct device_attribute attr, char buf)
	80	{
81	struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
82	struct axp20x_pek_ext_attr *axp20x_ea = get_axp_ext_attr(attr);
83	unsigned int val;
84	int ret, i;
85
86	ret = regmap_read(axp20x_pek->axp20x->regmap, AXP20X_PEK_KEY, &val);
87	if (ret != 0)
88	return ret;
89
90	val &= axp20x_ea->mask;
91	val >>= ffs(axp20x_ea->mask) - 1;
92
93	for (i = 0; i < 4; i++)
94	if (val == axp20x_ea->p_time[i].idx)
95	val = axp20x_ea->p_time[i].time;
96
97	return sprintf(buf, "%u\n", val);
98	}
99
100	static ssize_t axp20x_store_ext_attr(struct device *dev,
101	struct device_attribute *attr,
102	const char *buf, size_t count)
103	{
104	struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
105	struct axp20x_pek_ext_attr *axp20x_ea = get_axp_ext_attr(attr);
106	char val_str[20];
107	size_t len;
108	int ret, i;
109	unsigned int val, idx = 0;
110	unsigned int best_err = UINT_MAX;
111
112	val_str[sizeof(val_str) - 1] = '\0';
113	strncpy(val_str, buf, sizeof(val_str) - 1);
114	len = strlen(val_str);
115
116	if (len && val_str[len - 1] == '\n')
117	val_str[len - 1] = '\0';
118
119	ret = kstrtouint(val_str, 10, &val);
120	if (ret)
121	return ret;
122
123	for (i = 3; i >= 0; i--) {
124	unsigned int err;
125
126	err = abs(axp20x_ea->p_time[i].time - val);
127	if (err < best_err) {
128	best_err = err;
129	idx = axp20x_ea->p_time[i].idx;
130	}
131
132	if (!err)
133	break;
134	}
135
136	idx <<= ffs(axp20x_ea->mask) - 1;
137	ret = regmap_update_bits(axp20x_pek->axp20x->regmap,
138	AXP20X_PEK_KEY,
139	axp20x_ea->mask, idx);
140	if (ret != 0)
141	return -EINVAL;
b388de88	142
5b6c26a9 CC	143	return count;
	144	}
	145
	146	static struct dev_ext_attribute axp20x_dev_attr_startup = {
	147	.attr = __ATTR(startup, 0644, axp20x_show_ext_attr, axp20x_store_ext_attr),
b388de88	148	.var = &axp20x_pek_startup_ext_attr,
5b6c26a9 CC	149	};
	150
	151	static struct dev_ext_attribute axp20x_dev_attr_shutdown = {
	152	.attr = __ATTR(shutdown, 0644, axp20x_show_ext_attr, axp20x_store_ext_attr),
b388de88 DT	153	.var = &axp20x_pek_shutdown_ext_attr,
	154	};
	155
	156	static struct attribute *axp20x_attributes[] = {
	157	&axp20x_dev_attr_startup.attr.attr,
	158	&axp20x_dev_attr_shutdown.attr.attr,
	159	NULL,
	160	};
	161
	162	static const struct attribute_group axp20x_attribute_group = {
	163	.attrs = axp20x_attributes,
5b6c26a9 CC	164	};
	165
	166	static irqreturn_t axp20x_pek_irq(int irq, void *pwr)
	167	{
	168	struct input_dev *idev = pwr;
	169	struct axp20x_pek *axp20x_pek = input_get_drvdata(idev);
	170
eeeee40f HG	171	/*
	172	* The power-button is connected to ground so a falling edge (dbf)
	173	* means it is pressed.
	174	*/
	175	if (irq == axp20x_pek->irq_dbf)
5b6c26a9	176	input_report_key(idev, KEY_POWER, true);
eeeee40f	177	else if (irq == axp20x_pek->irq_dbr)
5b6c26a9 CC	178	input_report_key(idev, KEY_POWER, false);
	179
	180	input_sync(idev);
	181
	182	return IRQ_HANDLED;
	183	}
	184
b388de88 DT	185	static void axp20x_remove_sysfs_group(void *_data)
	186	{
	187	struct device *dev = _data;
	188
	189	sysfs_remove_group(&dev->kobj, &axp20x_attribute_group);
	190	}
	191
f2bd5a9e HG	192	static int axp20x_pek_probe_input_device(struct axp20x_pek *axp20x_pek,
f2bd5a9e HG	193	struct platform_device *pdev)
5b6c26a9	194	{
f2bd5a9e	195	struct axp20x_dev *axp20x = axp20x_pek->axp20x;
5b6c26a9 CC	196	struct input_dev *idev;
	197	int error;
	198
5b6c26a9 CC	199	axp20x_pek->irq_dbr = platform_get_irq_byname(pdev, "PEK_DBR");
	200	if (axp20x_pek->irq_dbr < 0) {
	201	dev_err(&pdev->dev, "No IRQ for PEK_DBR, error=%d\n",
	202	axp20x_pek->irq_dbr);
	203	return axp20x_pek->irq_dbr;
	204	}
	205	axp20x_pek->irq_dbr = regmap_irq_get_virq(axp20x->regmap_irqc,
	206	axp20x_pek->irq_dbr);
	207
	208	axp20x_pek->irq_dbf = platform_get_irq_byname(pdev, "PEK_DBF");
	209	if (axp20x_pek->irq_dbf < 0) {
	210	dev_err(&pdev->dev, "No IRQ for PEK_DBF, error=%d\n",
	211	axp20x_pek->irq_dbf);
	212	return axp20x_pek->irq_dbf;
	213	}
	214	axp20x_pek->irq_dbf = regmap_irq_get_virq(axp20x->regmap_irqc,
	215	axp20x_pek->irq_dbf);
	216
	217	axp20x_pek->input = devm_input_allocate_device(&pdev->dev);
	218	if (!axp20x_pek->input)
	219	return -ENOMEM;
	220
	221	idev = axp20x_pek->input;
	222
	223	idev->name = "axp20x-pek";
	224	idev->phys = "m1kbd/input2";
	225	idev->dev.parent = &pdev->dev;
	226
	227	input_set_capability(idev, EV_KEY, KEY_POWER);
	228
	229	input_set_drvdata(idev, axp20x_pek);
	230
	231	error = devm_request_any_context_irq(&pdev->dev, axp20x_pek->irq_dbr,
b388de88 DT	232	axp20x_pek_irq, 0,
b388de88 DT	233	"axp20x-pek-dbr", idev);
5b6c26a9	234	if (error < 0) {
73915f36	235	dev_err(&pdev->dev, "Failed to request dbr IRQ#%d: %d\n",
5b6c26a9	236	axp20x_pek->irq_dbr, error);
5b6c26a9 CC	237	return error;
	238	}
	239
	240	error = devm_request_any_context_irq(&pdev->dev, axp20x_pek->irq_dbf,
	241	axp20x_pek_irq, 0,
	242	"axp20x-pek-dbf", idev);
	243	if (error < 0) {
73915f36	244	dev_err(&pdev->dev, "Failed to request dbf IRQ#%d: %d\n",
5b6c26a9 CC	245	axp20x_pek->irq_dbf, error);
	246	return error;
	247	}
	248
f2bd5a9e HG	249	error = input_register_device(idev);
	250	if (error) {
	251	dev_err(&pdev->dev, "Can't register input device: %d\n",
	252	error);
	253	return error;
	254	}
	255
	256	return 0;
	257	}
	258
	259	static int axp20x_pek_probe(struct platform_device *pdev)
	260	{
	261	struct axp20x_pek *axp20x_pek;
	262	int error;
	263
	264	axp20x_pek = devm_kzalloc(&pdev->dev, sizeof(struct axp20x_pek),
	265	GFP_KERNEL);
	266	if (!axp20x_pek)
	267	return -ENOMEM;
	268
	269	axp20x_pek->axp20x = dev_get_drvdata(pdev->dev.parent);
	270
9b13a4ca HG	271	/*
	272	* Do not register the input device if there is an "INTCFD9"
	273	* gpio button ACPI device, that handles the power button too,
	274	* and otherwise we end up reporting all presses twice.
	275	*/
	276	if (!acpi_dev_found("INTCFD9") \|\|
	277	!IS_ENABLED(CONFIG_INPUT_SOC_BUTTON_ARRAY)) {
	278	error = axp20x_pek_probe_input_device(axp20x_pek, pdev);
	279	if (error)
	280	return error;
	281	}
f2bd5a9e	282
b388de88 DT	283	error = sysfs_create_group(&pdev->dev.kobj, &axp20x_attribute_group);
b388de88 DT	284	if (error) {
73915f36	285	dev_err(&pdev->dev, "Failed to create sysfs attributes: %d\n",
b388de88	286	error);
5b6c26a9	287	return error;
b388de88	288	}
5b6c26a9	289
b388de88 DT	290	error = devm_add_action(&pdev->dev,
	291	axp20x_remove_sysfs_group, &pdev->dev);
	292	if (error) {
	293	axp20x_remove_sysfs_group(&pdev->dev);
	294	dev_err(&pdev->dev, "Failed to add sysfs cleanup action: %d\n",
	295	error);
	296	return error;
	297	}
5b6c26a9	298
5b6c26a9 CC	299	platform_set_drvdata(pdev, axp20x_pek);
5b6c26a9 CC	300
5b6c26a9 CC	301	return 0;
	302	}
	303
	304	static struct platform_driver axp20x_pek_driver = {
	305	.probe = axp20x_pek_probe,
5b6c26a9 CC	306	.driver = {
	307	.name = "axp20x-pek",
	308	},
	309	};
	310	module_platform_driver(axp20x_pek_driver);
	311
	312	MODULE_DESCRIPTION("axp20x Power Button");
	313	MODULE_AUTHOR("Carlo Caione <carlo@caione.org>");
	314	MODULE_LICENSE("GPL");
b6e26546	315	MODULE_ALIAS("platform:axp20x-pek");