[thirdparty/kernel/stable.git] / drivers / input / apm-power.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 *  Input Power Event -> APM Bridge
 *
 *  Copyright (c) 2007 Richard Purdie
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/module.h>
#include <linux/input.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/tty.h>
#include <linux/delay.h>
#include <linux/pm.h>
#include <linux/apm-emulation.h>

static void system_power_event(unsigned int keycode)
{
	switch (keycode) {
	case KEY_SUSPEND:
		apm_queue_event(APM_USER_SUSPEND);
		pr_info("Requesting system suspend...\n");
		break;
	default:
		break;
	}
}

static void apmpower_event(struct input_handle *handle, unsigned int type,
			   unsigned int code, int value)
{
	/* only react on key down events */
	if (value != 1)
		return;

	switch (type) {
	case EV_PWR:
		system_power_event(code);
		break;

	default:
		break;
	}
}

static int apmpower_connect(struct input_handler *handler,
					  struct input_dev *dev,
					  const struct input_device_id *id)
{
	struct input_handle *handle;
	int error;

	handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL);
	if (!handle)
		return -ENOMEM;

	handle->dev = dev;
	handle->handler = handler;
	handle->name = "apm-power";

	error = input_register_handle(handle);
	if (error) {
		pr_err("Failed to register input power handler, error %d\n",
		       error);
		kfree(handle);
		return error;
	}

	error = input_open_device(handle);
	if (error) {
		pr_err("Failed to open input power device, error %d\n", error);
		input_unregister_handle(handle);
		kfree(handle);
		return error;
	}

	return 0;
}

static void apmpower_disconnect(struct input_handle *handle)
{
	input_close_device(handle);
	input_unregister_handle(handle);
	kfree(handle);
}

static const struct input_device_id apmpower_ids[] = {
	{
		.flags = INPUT_DEVICE_ID_MATCH_EVBIT,
		.evbit = { BIT_MASK(EV_PWR) },
	},
	{ },
};

MODULE_DEVICE_TABLE(input, apmpower_ids);

static struct input_handler apmpower_handler = {
	.event =	apmpower_event,
	.connect =	apmpower_connect,
	.disconnect =	apmpower_disconnect,
	.name =		"apm-power",
	.id_table =	apmpower_ids,
};

static int __init apmpower_init(void)
{
	return input_register_handler(&apmpower_handler);
}

static void __exit apmpower_exit(void)
{
	input_unregister_handler(&apmpower_handler);
}

module_init(apmpower_init);
module_exit(apmpower_exit);

MODULE_AUTHOR("Richard Purdie <rpurdie@rpsys.net>");
MODULE_DESCRIPTION("Input Power Event -> APM Bridge");
MODULE_LICENSE("GPL");
Commit	Line	Data
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
e17bb1de RP	2	/*
	3	* Input Power Event -> APM Bridge
	4	*
	5	* Copyright (c) 2007 Richard Purdie
e17bb1de RP	6	*/
e17bb1de RP	7
da0c4901 JP	8	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
da0c4901 JP	9
e17bb1de RP	10	#include <linux/module.h>
	11	#include <linux/input.h>
	12	#include <linux/slab.h>
	13	#include <linux/init.h>
	14	#include <linux/tty.h>
	15	#include <linux/delay.h>
	16	#include <linux/pm.h>
	17	#include <linux/apm-emulation.h>
	18
	19	static void system_power_event(unsigned int keycode)
	20	{
	21	switch (keycode) {
	22	case KEY_SUSPEND:
	23	apm_queue_event(APM_USER_SUSPEND);
da0c4901	24	pr_info("Requesting system suspend...\n");
e17bb1de RP	25	break;
	26	default:
	27	break;
	28	}
	29	}
	30
	31	static void apmpower_event(struct input_handle *handle, unsigned int type,
41091ad0	32	unsigned int code, int value)
e17bb1de RP	33	{
	34	/* only react on key down events */
	35	if (value != 1)
	36	return;
	37
	38	switch (type) {
	39	case EV_PWR:
	40	system_power_event(code);
	41	break;
	42
	43	default:
	44	break;
	45	}
	46	}
	47
	48	static int apmpower_connect(struct input_handler *handler,
	49	struct input_dev *dev,
	50	const struct input_device_id *id)
	51	{
	52	struct input_handle *handle;
	53	int error;
	54
	55	handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL);
	56	if (!handle)
	57	return -ENOMEM;
	58
	59	handle->dev = dev;
	60	handle->handler = handler;
	61	handle->name = "apm-power";
	62
e17bb1de RP	63	error = input_register_handle(handle);
e17bb1de RP	64	if (error) {
da0c4901 JP	65	pr_err("Failed to register input power handler, error %d\n",
da0c4901 JP	66	error);
e17bb1de RP	67	kfree(handle);
	68	return error;
	69	}
	70
	71	error = input_open_device(handle);
	72	if (error) {
da0c4901	73	pr_err("Failed to open input power device, error %d\n", error);
e17bb1de RP	74	input_unregister_handle(handle);
	75	kfree(handle);
	76	return error;
	77	}
	78
	79	return 0;
	80	}
	81
481419ec	82	static void apmpower_disconnect(struct input_handle *handle)
e17bb1de	83	{
e17bb1de	84	input_close_device(handle);
481419ec	85	input_unregister_handle(handle);
e17bb1de RP	86	kfree(handle);
	87	}
	88
	89	static const struct input_device_id apmpower_ids[] = {
	90	{
	91	.flags = INPUT_DEVICE_ID_MATCH_EVBIT,
	92	.evbit = { BIT_MASK(EV_PWR) },
	93	},
	94	{ },
	95	};
	96
	97	MODULE_DEVICE_TABLE(input, apmpower_ids);
	98
	99	static struct input_handler apmpower_handler = {
	100	.event = apmpower_event,
	101	.connect = apmpower_connect,
	102	.disconnect = apmpower_disconnect,
	103	.name = "apm-power",
	104	.id_table = apmpower_ids,
	105	};
	106
	107	static int __init apmpower_init(void)
	108	{
	109	return input_register_handler(&apmpower_handler);
	110	}
	111
	112	static void __exit apmpower_exit(void)
	113	{
	114	input_unregister_handler(&apmpower_handler);
	115	}
	116
	117	module_init(apmpower_init);
	118	module_exit(apmpower_exit);
	119
	120	MODULE_AUTHOR("Richard Purdie <rpurdie@rpsys.net>");
	121	MODULE_DESCRIPTION("Input Power Event -> APM Bridge");
	122	MODULE_LICENSE("GPL");