[linux-2.6-block.git] / net / rfkill / rfkill-input.c

/*
 * Input layer to RF Kill interface connector
 *
 * Copyright (c) 2007 Dmitry Torokhov
 */

/*
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published
 * by the Free Software Foundation.
 */

#include <linux/module.h>
#include <linux/input.h>
#include <linux/slab.h>
#include <linux/workqueue.h>
#include <linux/init.h>
#include <linux/rfkill.h>
#include <linux/sched.h>

#include "rfkill-input.h"

MODULE_AUTHOR("Dmitry Torokhov <dtor@mail.ru>");
MODULE_DESCRIPTION("Input layer to RF switch connector");
MODULE_LICENSE("GPL");

enum rfkill_input_master_mode {
	RFKILL_INPUT_MASTER_DONOTHING = 0,
	RFKILL_INPUT_MASTER_RESTORE = 1,
	RFKILL_INPUT_MASTER_UNBLOCKALL = 2,
	RFKILL_INPUT_MASTER_MAX,	/* marker */
};

/* Delay (in ms) between consecutive switch ops */
#define RFKILL_OPS_DELAY 200

static enum rfkill_input_master_mode rfkill_master_switch_mode =
					RFKILL_INPUT_MASTER_UNBLOCKALL;
module_param_named(master_switch_mode, rfkill_master_switch_mode, uint, 0);
MODULE_PARM_DESC(master_switch_mode,
	"SW_RFKILL_ALL ON should: 0=do nothing; 1=restore; 2=unblock all");

enum rfkill_global_sched_op {
	RFKILL_GLOBAL_OP_EPO = 0,
	RFKILL_GLOBAL_OP_RESTORE,
	RFKILL_GLOBAL_OP_UNLOCK,
	RFKILL_GLOBAL_OP_UNBLOCK,
};

struct rfkill_task {
	struct delayed_work dwork;

	/* ensures that task is serialized */
	struct mutex mutex;

	/* protects everything below */
	spinlock_t lock;

	/* pending regular switch operations (1=pending) */
	unsigned long sw_pending[BITS_TO_LONGS(RFKILL_TYPE_MAX)];

	/* should the state be complemented (1=yes) */
	unsigned long sw_togglestate[BITS_TO_LONGS(RFKILL_TYPE_MAX)];

	bool global_op_pending;
	enum rfkill_global_sched_op op;

	/* last time it was scheduled */
	unsigned long last_scheduled;
};

static void __rfkill_handle_global_op(enum rfkill_global_sched_op op)
{
	unsigned int i;

	switch (op) {
	case RFKILL_GLOBAL_OP_EPO:
		rfkill_epo();
		break;
	case RFKILL_GLOBAL_OP_RESTORE:
		rfkill_restore_states();
		break;
	case RFKILL_GLOBAL_OP_UNLOCK:
		rfkill_remove_epo_lock();
		break;
	case RFKILL_GLOBAL_OP_UNBLOCK:
		rfkill_remove_epo_lock();
		for (i = 0; i < RFKILL_TYPE_MAX; i++)
			rfkill_switch_all(i, RFKILL_STATE_UNBLOCKED);
		break;
	default:
		/* memory corruption or bug, fail safely */
		rfkill_epo();
		WARN(1, "Unknown requested operation %d! "
			"rfkill Emergency Power Off activated\n",
			op);
	}
}

static void __rfkill_handle_normal_op(const enum rfkill_type type,
			const bool c)
{
	enum rfkill_state state;

	state = rfkill_get_global_state(type);
	if (c)
		state = rfkill_state_complement(state);

	rfkill_switch_all(type, state);
}

static void rfkill_task_handler(struct work_struct *work)
{
	struct rfkill_task *task = container_of(work,
					struct rfkill_task, dwork.work);
	bool doit = true;

	mutex_lock(&task->mutex);

	spin_lock_irq(&task->lock);
	while (doit) {
		if (task->global_op_pending) {
			enum rfkill_global_sched_op op = task->op;
			task->global_op_pending = false;
			memset(task->sw_pending, 0, sizeof(task->sw_pending));
			spin_unlock_irq(&task->lock);

			__rfkill_handle_global_op(op);

			/* make sure we do at least one pass with
			 * !task->global_op_pending */
			spin_lock_irq(&task->lock);
			continue;
		} else if (!rfkill_is_epo_lock_active()) {
			unsigned int i = 0;

			while (!task->global_op_pending &&
						i < RFKILL_TYPE_MAX) {
				if (test_and_clear_bit(i, task->sw_pending)) {
					bool c;
					c = test_and_clear_bit(i,
							task->sw_togglestate);
					spin_unlock_irq(&task->lock);

					__rfkill_handle_normal_op(i, c);

					spin_lock_irq(&task->lock);
				}
				i++;
			}
		}
		doit = task->global_op_pending;
	}
	spin_unlock_irq(&task->lock);

	mutex_unlock(&task->mutex);
}

static struct rfkill_task rfkill_task = {
	.dwork = __DELAYED_WORK_INITIALIZER(rfkill_task.dwork,
				rfkill_task_handler),
	.mutex = __MUTEX_INITIALIZER(rfkill_task.mutex),
	.lock = __SPIN_LOCK_UNLOCKED(rfkill_task.lock),
};

static unsigned long rfkill_ratelimit(const unsigned long last)
{
	const unsigned long delay = msecs_to_jiffies(RFKILL_OPS_DELAY);
	return (time_after(jiffies, last + delay)) ? 0 : delay;
}

static void rfkill_schedule_ratelimited(void)
{
	if (!delayed_work_pending(&rfkill_task.dwork)) {
		schedule_delayed_work(&rfkill_task.dwork,
				rfkill_ratelimit(rfkill_task.last_scheduled));
		rfkill_task.last_scheduled = jiffies;
	}
}

static void rfkill_schedule_global_op(enum rfkill_global_sched_op op)
{
	unsigned long flags;

	spin_lock_irqsave(&rfkill_task.lock, flags);
	rfkill_task.op = op;
	rfkill_task.global_op_pending = true;
	if (op == RFKILL_GLOBAL_OP_EPO && !rfkill_is_epo_lock_active()) {
		/* bypass the limiter for EPO */
		cancel_delayed_work(&rfkill_task.dwork);
		schedule_delayed_work(&rfkill_task.dwork, 0);
		rfkill_task.last_scheduled = jiffies;
	} else
		rfkill_schedule_ratelimited();
	spin_unlock_irqrestore(&rfkill_task.lock, flags);
}

static void rfkill_schedule_toggle(enum rfkill_type type)
{
	unsigned long flags;

	if (rfkill_is_epo_lock_active())
		return;

	spin_lock_irqsave(&rfkill_task.lock, flags);
	if (!rfkill_task.global_op_pending) {
		set_bit(type, rfkill_task.sw_pending);
		change_bit(type, rfkill_task.sw_togglestate);
		rfkill_schedule_ratelimited();
	}
	spin_unlock_irqrestore(&rfkill_task.lock, flags);
}

static void rfkill_schedule_evsw_rfkillall(int state)
{
	if (state) {
		switch (rfkill_master_switch_mode) {
		case RFKILL_INPUT_MASTER_UNBLOCKALL:
			rfkill_schedule_global_op(RFKILL_GLOBAL_OP_UNBLOCK);
			break;
		case RFKILL_INPUT_MASTER_RESTORE:
			rfkill_schedule_global_op(RFKILL_GLOBAL_OP_RESTORE);
			break;
		case RFKILL_INPUT_MASTER_DONOTHING:
			rfkill_schedule_global_op(RFKILL_GLOBAL_OP_UNLOCK);
			break;
		default:
			/* memory corruption or driver bug! fail safely */
			rfkill_schedule_global_op(RFKILL_GLOBAL_OP_EPO);
			WARN(1, "Unknown rfkill_master_switch_mode (%d), "
				"driver bug or memory corruption detected!\n",
				rfkill_master_switch_mode);
			break;
		}
	} else
		rfkill_schedule_global_op(RFKILL_GLOBAL_OP_EPO);
}

static void rfkill_event(struct input_handle *handle, unsigned int type,
			unsigned int code, int data)
{
	if (type == EV_KEY && data == 1) {
		enum rfkill_type t;

		switch (code) {
		case KEY_WLAN:
			t = RFKILL_TYPE_WLAN;
			break;
		case KEY_BLUETOOTH:
			t = RFKILL_TYPE_BLUETOOTH;
			break;
		case KEY_UWB:
			t = RFKILL_TYPE_UWB;
			break;
		case KEY_WIMAX:
			t = RFKILL_TYPE_WIMAX;
			break;
		default:
			return;
		}
		rfkill_schedule_toggle(t);
		return;
	} else if (type == EV_SW) {
		switch (code) {
		case SW_RFKILL_ALL:
			rfkill_schedule_evsw_rfkillall(data);
			return;
		default:
			return;
		}
	}
}

static int rfkill_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 = "rfkill";

	/* causes rfkill_start() to be called */
	error = input_register_handle(handle);
	if (error)
		goto err_free_handle;

	error = input_open_device(handle);
	if (error)
		goto err_unregister_handle;

	return 0;

 err_unregister_handle:
	input_unregister_handle(handle);
 err_free_handle:
	kfree(handle);
	return error;
}

static void rfkill_start(struct input_handle *handle)
{
	/* Take event_lock to guard against configuration changes, we
	 * should be able to deal with concurrency with rfkill_event()
	 * just fine (which event_lock will also avoid). */
	spin_lock_irq(&handle->dev->event_lock);

	if (test_bit(EV_SW, handle->dev->evbit)) {
		if (test_bit(SW_RFKILL_ALL, handle->dev->swbit))
			rfkill_schedule_evsw_rfkillall(test_bit(SW_RFKILL_ALL,
							handle->dev->sw));
		/* add resync for further EV_SW events here */
	}

	spin_unlock_irq(&handle->dev->event_lock);
}

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

static const struct input_device_id rfkill_ids[] = {
	{
		.flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT,
		.evbit = { BIT_MASK(EV_KEY) },
		.keybit = { [BIT_WORD(KEY_WLAN)] = BIT_MASK(KEY_WLAN) },
	},
	{
		.flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT,
		.evbit = { BIT_MASK(EV_KEY) },
		.keybit = { [BIT_WORD(KEY_BLUETOOTH)] = BIT_MASK(KEY_BLUETOOTH) },
	},
	{
		.flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT,
		.evbit = { BIT_MASK(EV_KEY) },
		.keybit = { [BIT_WORD(KEY_UWB)] = BIT_MASK(KEY_UWB) },
	},
	{
		.flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT,
		.evbit = { BIT_MASK(EV_KEY) },
		.keybit = { [BIT_WORD(KEY_WIMAX)] = BIT_MASK(KEY_WIMAX) },
	},
	{
		.flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_SWBIT,
		.evbit = { BIT(EV_SW) },
		.swbit = { [BIT_WORD(SW_RFKILL_ALL)] = BIT_MASK(SW_RFKILL_ALL) },
	},
	{ }
};

static struct input_handler rfkill_handler = {
	.event =	rfkill_event,
	.connect =	rfkill_connect,
	.disconnect =	rfkill_disconnect,
	.start =	rfkill_start,
	.name =		"rfkill",
	.id_table =	rfkill_ids,
};

static int __init rfkill_handler_init(void)
{
	if (rfkill_master_switch_mode >= RFKILL_INPUT_MASTER_MAX)
		return -EINVAL;

	/*
	 * The penalty to not doing this is a possible RFKILL_OPS_DELAY delay
	 * at the first use.  Acceptable, but if we can avoid it, why not?
	 */
	rfkill_task.last_scheduled =
			jiffies - msecs_to_jiffies(RFKILL_OPS_DELAY) - 1;
	return input_register_handler(&rfkill_handler);
}

static void __exit rfkill_handler_exit(void)
{
	input_unregister_handler(&rfkill_handler);
	cancel_delayed_work_sync(&rfkill_task.dwork);
	rfkill_remove_epo_lock();
}

module_init(rfkill_handler_init);
module_exit(rfkill_handler_exit);
Commit	Line	Data
cf4328cd ID	1	/*
	2	* Input layer to RF Kill interface connector
	3	*
	4	* Copyright (c) 2007 Dmitry Torokhov
	5	*/
	6
	7	/*
	8	* This program is free software; you can redistribute it and/or modify it
	9	* under the terms of the GNU General Public License version 2 as published
	10	* by the Free Software Foundation.
	11	*/
	12
	13	#include <linux/module.h>
	14	#include <linux/input.h>
	15	#include <linux/slab.h>
	16	#include <linux/workqueue.h>
	17	#include <linux/init.h>
	18	#include <linux/rfkill.h>
56f26f7b	19	#include <linux/sched.h>
cf4328cd	20
fe242cfd ID	21	#include "rfkill-input.h"
fe242cfd ID	22
cf4328cd ID	23	MODULE_AUTHOR("Dmitry Torokhov <dtor@mail.ru>");
	24	MODULE_DESCRIPTION("Input layer to RF switch connector");
	25	MODULE_LICENSE("GPL");
	26
d003922d HMH	27	enum rfkill_input_master_mode {
	28	RFKILL_INPUT_MASTER_DONOTHING = 0,
	29	RFKILL_INPUT_MASTER_RESTORE = 1,
	30	RFKILL_INPUT_MASTER_UNBLOCKALL = 2,
	31	RFKILL_INPUT_MASTER_MAX, /* marker */
	32	};
	33
78236571 HMH	34	/* Delay (in ms) between consecutive switch ops */
	35	#define RFKILL_OPS_DELAY 200
	36
d003922d HMH	37	static enum rfkill_input_master_mode rfkill_master_switch_mode =
	38	RFKILL_INPUT_MASTER_UNBLOCKALL;
	39	module_param_named(master_switch_mode, rfkill_master_switch_mode, uint, 0);
	40	MODULE_PARM_DESC(master_switch_mode,
	41	"SW_RFKILL_ALL ON should: 0=do nothing; 1=restore; 2=unblock all");
	42
	43	enum rfkill_global_sched_op {
	44	RFKILL_GLOBAL_OP_EPO = 0,
	45	RFKILL_GLOBAL_OP_RESTORE,
	46	RFKILL_GLOBAL_OP_UNLOCK,
	47	RFKILL_GLOBAL_OP_UNBLOCK,
	48	};
	49
cf4328cd	50	struct rfkill_task {
78236571	51	struct delayed_work dwork;
d003922d HMH	52
	53	/* ensures that task is serialized */
	54	struct mutex mutex;
	55
	56	/* protects everything below */
	57	spinlock_t lock;
	58
	59	/* pending regular switch operations (1=pending) */
	60	unsigned long sw_pending[BITS_TO_LONGS(RFKILL_TYPE_MAX)];
	61
d003922d HMH	62	/* should the state be complemented (1=yes) */
	63	unsigned long sw_togglestate[BITS_TO_LONGS(RFKILL_TYPE_MAX)];
	64
	65	bool global_op_pending;
	66	enum rfkill_global_sched_op op;
78236571 HMH	67
	68	/* last time it was scheduled */
	69	unsigned long last_scheduled;
cf4328cd ID	70	};
cf4328cd ID	71
d003922d	72	static void __rfkill_handle_global_op(enum rfkill_global_sched_op op)
cf4328cd	73	{
d003922d HMH	74	unsigned int i;
	75
	76	switch (op) {
	77	case RFKILL_GLOBAL_OP_EPO:
	78	rfkill_epo();
	79	break;
	80	case RFKILL_GLOBAL_OP_RESTORE:
	81	rfkill_restore_states();
	82	break;
	83	case RFKILL_GLOBAL_OP_UNLOCK:
	84	rfkill_remove_epo_lock();
	85	break;
	86	case RFKILL_GLOBAL_OP_UNBLOCK:
	87	rfkill_remove_epo_lock();
	88	for (i = 0; i < RFKILL_TYPE_MAX; i++)
	89	rfkill_switch_all(i, RFKILL_STATE_UNBLOCKED);
	90	break;
	91	default:
	92	/* memory corruption or bug, fail safely */
	93	rfkill_epo();
	94	WARN(1, "Unknown requested operation %d! "
	95	"rfkill Emergency Power Off activated\n",
	96	op);
	97	}
	98	}
cf4328cd	99
d003922d HMH	100	static void __rfkill_handle_normal_op(const enum rfkill_type type,
	101	const bool c)
	102	{
	103	enum rfkill_state state;
	104
	105	state = rfkill_get_global_state(type);
	106	if (c)
	107	state = rfkill_state_complement(state);
	108
	109	rfkill_switch_all(type, state);
	110	}
cf4328cd	111
d003922d	112	static void rfkill_task_handler(struct work_struct *work)
4081f00d	113	{
78236571 HMH	114	struct rfkill_task *task = container_of(work,
78236571 HMH	115	struct rfkill_task, dwork.work);
d003922d HMH	116	bool doit = true;
	117
	118	mutex_lock(&task->mutex);
	119
	120	spin_lock_irq(&task->lock);
	121	while (doit) {
	122	if (task->global_op_pending) {
	123	enum rfkill_global_sched_op op = task->op;
	124	task->global_op_pending = false;
	125	memset(task->sw_pending, 0, sizeof(task->sw_pending));
	126	spin_unlock_irq(&task->lock);
	127
	128	__rfkill_handle_global_op(op);
	129
	130	/* make sure we do at least one pass with
	131	* !task->global_op_pending */
	132	spin_lock_irq(&task->lock);
	133	continue;
	134	} else if (!rfkill_is_epo_lock_active()) {
	135	unsigned int i = 0;
	136
	137	while (!task->global_op_pending &&
	138	i < RFKILL_TYPE_MAX) {
	139	if (test_and_clear_bit(i, task->sw_pending)) {
	140	bool c;
d003922d HMH	141	c = test_and_clear_bit(i,
	142	task->sw_togglestate);
	143	spin_unlock_irq(&task->lock);
	144
d003922d	145	__rfkill_handle_normal_op(i, c);
d003922d HMH	146
	147	spin_lock_irq(&task->lock);
	148	}
	149	i++;
	150	}
	151	}
	152	doit = task->global_op_pending;
	153	}
	154	spin_unlock_irq(&task->lock);
	155
	156	mutex_unlock(&task->mutex);
4081f00d HMH	157	}
4081f00d HMH	158
d003922d	159	static struct rfkill_task rfkill_task = {
78236571	160	.dwork = __DELAYED_WORK_INITIALIZER(rfkill_task.dwork,
d003922d HMH	161	rfkill_task_handler),
	162	.mutex = __MUTEX_INITIALIZER(rfkill_task.mutex),
	163	.lock = __SPIN_LOCK_UNLOCKED(rfkill_task.lock),
	164	};
4081f00d	165
78236571 HMH	166	static unsigned long rfkill_ratelimit(const unsigned long last)
	167	{
	168	const unsigned long delay = msecs_to_jiffies(RFKILL_OPS_DELAY);
	169	return (time_after(jiffies, last + delay)) ? 0 : delay;
	170	}
	171
	172	static void rfkill_schedule_ratelimited(void)
	173	{
	174	if (!delayed_work_pending(&rfkill_task.dwork)) {
	175	schedule_delayed_work(&rfkill_task.dwork,
	176	rfkill_ratelimit(rfkill_task.last_scheduled));
	177	rfkill_task.last_scheduled = jiffies;
	178	}
	179	}
	180
d003922d	181	static void rfkill_schedule_global_op(enum rfkill_global_sched_op op)
4081f00d	182	{
d003922d HMH	183	unsigned long flags;
	184
	185	spin_lock_irqsave(&rfkill_task.lock, flags);
	186	rfkill_task.op = op;
	187	rfkill_task.global_op_pending = true;
78236571 HMH	188	if (op == RFKILL_GLOBAL_OP_EPO && !rfkill_is_epo_lock_active()) {
	189	/* bypass the limiter for EPO */
	190	cancel_delayed_work(&rfkill_task.dwork);
	191	schedule_delayed_work(&rfkill_task.dwork, 0);
	192	rfkill_task.last_scheduled = jiffies;
	193	} else
	194	rfkill_schedule_ratelimited();
d003922d	195	spin_unlock_irqrestore(&rfkill_task.lock, flags);
4081f00d HMH	196	}
4081f00d HMH	197
d003922d	198	static void rfkill_schedule_toggle(enum rfkill_type type)
cf4328cd	199	{
e6c9116d	200	unsigned long flags;
cf4328cd	201
d003922d	202	if (rfkill_is_epo_lock_active())
4081f00d HMH	203	return;
4081f00d HMH	204
d003922d HMH	205	spin_lock_irqsave(&rfkill_task.lock, flags);
	206	if (!rfkill_task.global_op_pending) {
	207	set_bit(type, rfkill_task.sw_pending);
	208	change_bit(type, rfkill_task.sw_togglestate);
78236571	209	rfkill_schedule_ratelimited();
cf4328cd	210	}
d003922d	211	spin_unlock_irqrestore(&rfkill_task.lock, flags);
cf4328cd ID	212	}
cf4328cd ID	213
6e28fbef HMH	214	static void rfkill_schedule_evsw_rfkillall(int state)
6e28fbef HMH	215	{
6e28fbef	216	if (state) {
d003922d HMH	217	switch (rfkill_master_switch_mode) {
	218	case RFKILL_INPUT_MASTER_UNBLOCKALL:
	219	rfkill_schedule_global_op(RFKILL_GLOBAL_OP_UNBLOCK);
	220	break;
	221	case RFKILL_INPUT_MASTER_RESTORE:
	222	rfkill_schedule_global_op(RFKILL_GLOBAL_OP_RESTORE);
	223	break;
	224	case RFKILL_INPUT_MASTER_DONOTHING:
	225	rfkill_schedule_global_op(RFKILL_GLOBAL_OP_UNLOCK);
	226	break;
	227	default:
	228	/* memory corruption or driver bug! fail safely */
	229	rfkill_schedule_global_op(RFKILL_GLOBAL_OP_EPO);
	230	WARN(1, "Unknown rfkill_master_switch_mode (%d), "
	231	"driver bug or memory corruption detected!\n",
	232	rfkill_master_switch_mode);
	233	break;
	234	}
6e28fbef	235	} else
d003922d	236	rfkill_schedule_global_op(RFKILL_GLOBAL_OP_EPO);
6e28fbef HMH	237	}
6e28fbef HMH	238
cf4328cd	239	static void rfkill_event(struct input_handle *handle, unsigned int type,
28f089c1	240	unsigned int code, int data)
cf4328cd	241	{
28f089c1	242	if (type == EV_KEY && data == 1) {
d003922d HMH	243	enum rfkill_type t;
d003922d HMH	244
cf4328cd ID	245	switch (code) {
cf4328cd ID	246	case KEY_WLAN:
d003922d	247	t = RFKILL_TYPE_WLAN;
cf4328cd ID	248	break;
cf4328cd ID	249	case KEY_BLUETOOTH:
d003922d	250	t = RFKILL_TYPE_BLUETOOTH;
cf4328cd	251	break;
e0665486	252	case KEY_UWB:
d003922d	253	t = RFKILL_TYPE_UWB;
e0665486	254	break;
303d9bf6	255	case KEY_WIMAX:
d003922d	256	t = RFKILL_TYPE_WIMAX;
303d9bf6	257	break;
cf4328cd	258	default:
d003922d	259	return;
cf4328cd	260	}
d003922d HMH	261	rfkill_schedule_toggle(t);
d003922d HMH	262	return;
28f089c1 HMH	263	} else if (type == EV_SW) {
	264	switch (code) {
	265	case SW_RFKILL_ALL:
6e28fbef	266	rfkill_schedule_evsw_rfkillall(data);
d003922d	267	return;
28f089c1	268	default:
d003922d	269	return;
28f089c1	270	}
cf4328cd ID	271	}
	272	}
	273
	274	static int rfkill_connect(struct input_handler handler, struct input_dev dev,
	275	const struct input_device_id *id)
	276	{
	277	struct input_handle *handle;
	278	int error;
	279
	280	handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL);
	281	if (!handle)
	282	return -ENOMEM;
	283
	284	handle->dev = dev;
	285	handle->handler = handler;
	286	handle->name = "rfkill";
	287
6e28fbef	288	/* causes rfkill_start() to be called */
cf4328cd ID	289	error = input_register_handle(handle);
	290	if (error)
	291	goto err_free_handle;
	292
	293	error = input_open_device(handle);
	294	if (error)
	295	goto err_unregister_handle;
	296
	297	return 0;
	298
	299	err_unregister_handle:
	300	input_unregister_handle(handle);
	301	err_free_handle:
	302	kfree(handle);
	303	return error;
	304	}
	305
6e28fbef HMH	306	static void rfkill_start(struct input_handle *handle)
	307	{
	308	/* Take event_lock to guard against configuration changes, we
	309	* should be able to deal with concurrency with rfkill_event()
	310	* just fine (which event_lock will also avoid). */
	311	spin_lock_irq(&handle->dev->event_lock);
	312
	313	if (test_bit(EV_SW, handle->dev->evbit)) {
	314	if (test_bit(SW_RFKILL_ALL, handle->dev->swbit))
	315	rfkill_schedule_evsw_rfkillall(test_bit(SW_RFKILL_ALL,
	316	handle->dev->sw));
	317	/* add resync for further EV_SW events here */
	318	}
	319
	320	spin_unlock_irq(&handle->dev->event_lock);
	321	}
	322
cf4328cd ID	323	static void rfkill_disconnect(struct input_handle *handle)
	324	{
	325	input_close_device(handle);
	326	input_unregister_handle(handle);
	327	kfree(handle);
	328	}
	329
	330	static const struct input_device_id rfkill_ids[] = {
	331	{
	332	.flags = INPUT_DEVICE_ID_MATCH_EVBIT \| INPUT_DEVICE_ID_MATCH_KEYBIT,
7b19ada2 JS	333	.evbit = { BIT_MASK(EV_KEY) },
7b19ada2 JS	334	.keybit = { [BIT_WORD(KEY_WLAN)] = BIT_MASK(KEY_WLAN) },
cf4328cd ID	335	},
	336	{
	337	.flags = INPUT_DEVICE_ID_MATCH_EVBIT \| INPUT_DEVICE_ID_MATCH_KEYBIT,
7b19ada2 JS	338	.evbit = { BIT_MASK(EV_KEY) },
7b19ada2 JS	339	.keybit = { [BIT_WORD(KEY_BLUETOOTH)] = BIT_MASK(KEY_BLUETOOTH) },
cf4328cd	340	},
e0665486 ID	341	{
e0665486 ID	342	.flags = INPUT_DEVICE_ID_MATCH_EVBIT \| INPUT_DEVICE_ID_MATCH_KEYBIT,
7b19ada2 JS	343	.evbit = { BIT_MASK(EV_KEY) },
7b19ada2 JS	344	.keybit = { [BIT_WORD(KEY_UWB)] = BIT_MASK(KEY_UWB) },
e0665486	345	},
303d9bf6 IPG	346	{
	347	.flags = INPUT_DEVICE_ID_MATCH_EVBIT \| INPUT_DEVICE_ID_MATCH_KEYBIT,
	348	.evbit = { BIT_MASK(EV_KEY) },
	349	.keybit = { [BIT_WORD(KEY_WIMAX)] = BIT_MASK(KEY_WIMAX) },
	350	},
28f089c1 HMH	351	{
	352	.flags = INPUT_DEVICE_ID_MATCH_EVBIT \| INPUT_DEVICE_ID_MATCH_SWBIT,
	353	.evbit = { BIT(EV_SW) },
	354	.swbit = { [BIT_WORD(SW_RFKILL_ALL)] = BIT_MASK(SW_RFKILL_ALL) },
	355	},
cf4328cd ID	356	{ }
	357	};
	358
	359	static struct input_handler rfkill_handler = {
	360	.event = rfkill_event,
	361	.connect = rfkill_connect,
	362	.disconnect = rfkill_disconnect,
6e28fbef	363	.start = rfkill_start,
cf4328cd ID	364	.name = "rfkill",
	365	.id_table = rfkill_ids,
	366	};
	367
	368	static int __init rfkill_handler_init(void)
	369	{
d003922d HMH	370	if (rfkill_master_switch_mode >= RFKILL_INPUT_MASTER_MAX)
	371	return -EINVAL;
	372
78236571 HMH	373	/*
	374	* The penalty to not doing this is a possible RFKILL_OPS_DELAY delay
	375	* at the first use. Acceptable, but if we can avoid it, why not?
	376	*/
	377	rfkill_task.last_scheduled =
	378	jiffies - msecs_to_jiffies(RFKILL_OPS_DELAY) - 1;
cf4328cd ID	379	return input_register_handler(&rfkill_handler);
	380	}
	381
	382	static void __exit rfkill_handler_exit(void)
	383	{
	384	input_unregister_handler(&rfkill_handler);
78236571	385	cancel_delayed_work_sync(&rfkill_task.dwork);
d003922d	386	rfkill_remove_epo_lock();
cf4328cd ID	387	}
	388
	389	module_init(rfkill_handler_init);
	390	module_exit(rfkill_handler_exit);