KumiSystems/openwrtv4
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity

package/button-hotplug: handle KEY_RESTART and KEY_WPS_BUTTON codes as well

Browse source 
SVN-Revision: 21074
This commit is contained in:
Gabor Juhos 2010-04-21 19:07:14 +00:00
parent b303c5e2b9
commit 7abcc664c6
1 changed files with 52 additions and 21 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

73
package/button-hotplug/src/button-hotplug.c
View file

@ -1,7 +1,7 @@
/*
* Button Hotplug driver
*
* Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>
* Copyright (C) 2008-2010 Gabor Juhos <juhosg@openwrt.org>
*
* Based on the diag.c - GPIO interface driver for Broadcom boards
* Copyright (C) 2006 Mike Baker <mbm@openwrt.org>,
@ -24,16 +24,11 @@
#include <net/sock.h>
#define DRV_NAME "button-hotplug"
#define DRV_VERSION "0.3.1"
#define DRV_VERSION "0.4.0"
#define DRV_DESC "Button Hotplug driver"
#define BH_SKB_SIZE 2048
#define BH_BTN_MIN BTN_0
#define BH_BTN_MAX BTN_9
#define BH_BTN_COUNT (BH_BTN_MAX - BH_BTN_MIN + 1)
#define PFX DRV_NAME ": "
#undef BH_DEBUG
@ -51,12 +46,12 @@
#endif
struct bh_priv {
unsigned long seen[BH_BTN_COUNT];
unsigned long *seen;
struct input_handle handle;
};
struct bh_event {
char *name;
const char *name;
char *action;
unsigned long seen;
@ -64,12 +59,35 @@ struct bh_event {
struct work_struct work;
};
struct bh_map {
unsigned int code;
const char *name;
};
extern struct sock *uevent_sock;
extern u64 uevent_next_seqnum(void);
static char *button_names[BH_BTN_COUNT] = {
"BTN_0", "BTN_1", "BTN_2", "BTN_3", "BTN_4",
"BTN_5", "BTN_6", "BTN_7", "BTN_8", "BTN_9"
#define BH_MAP(_code, _name) \
{ \
.code = (_code), \
.name = (_name), \
}
static struct bh_map button_map[] = {
BH_MAP(BTN_0, "BTN_0"),
BH_MAP(BTN_1, "BTN_1"),
BH_MAP(BTN_2, "BTN_2"),
BH_MAP(BTN_3, "BTN_3"),
BH_MAP(BTN_4, "BTN_4"),
BH_MAP(BTN_5, "BTN_5"),
BH_MAP(BTN_6, "BTN_6"),
BH_MAP(BTN_7, "BTN_7"),
BH_MAP(BTN_8, "BTN_8"),
BH_MAP(BTN_9, "BTN_9"),
BH_MAP(KEY_RESTART, "reset"),
#ifdef KEY_WPS_BUTTON
BH_MAP(KEY_WPS_BUTTON, "wps"),
#endif /* KEY_WPS_BUTTON */
};
/* -------------------------------------------------------------------------*/
@ -169,7 +187,7 @@ static void button_hotplug_work(struct work_struct *work)
kfree(event);
}
static int button_hotplug_create_event(char *name, unsigned long seen,
static int button_hotplug_create_event(const char *name, unsigned long seen,
int pressed)
{
struct bh_event *event;
@ -194,23 +212,33 @@ static int button_hotplug_create_event(char *name, unsigned long seen,
/* -------------------------------------------------------------------------*/
#ifdef CONFIG_HOTPLUG
static int button_get_index(unsigned int code)
{
int i;
for (i = 0; i < ARRAY_SIZE(button_map); i++)
if (button_map[i].code == code)
return i;
return -1;
}
static void button_hotplug_event(struct input_handle *handle,
unsigned int type, unsigned int code, int value)
{
struct bh_priv *priv = handle->private;
unsigned long seen = jiffies;
unsigned int btn;
int btn;
BH_DBG("event type=%u, code=%u, value=%d\n", type, code, value);
if (type != EV_KEY)
return;
if (code < BH_BTN_MIN || code > BH_BTN_MAX)
btn = button_get_index(code);
if (btn < 0)
return;
btn = code - BH_BTN_MIN;
button_hotplug_create_event(button_names[btn],
button_hotplug_create_event(button_map[btn].name,
(seen - priv->seen[btn]) / HZ, value);
priv->seen[btn] = seen;
}
@ -228,17 +256,20 @@ static int button_hotplug_connect(struct input_handler *handler,
int ret;
int i;
for (i = BH_BTN_MIN; i <= BH_BTN_MAX; i++)
if (test_bit(i, dev->keybit))
for (i = 0; i < ARRAY_SIZE(button_map); i++)
if (test_bit(button_map[i].code, dev->keybit))
break;
if (i > BH_BTN_MAX)
if (i == ARRAY_SIZE(button_map))
return -ENODEV;
priv = kzalloc(sizeof(*priv), GFP_KERNEL);
priv = kzalloc(sizeof(*priv) +
(sizeof(unsigned long) * ARRAY_SIZE(button_map)),
GFP_KERNEL);
if (!priv)
return -ENOMEM;
priv->seen = (unsigned long *) &priv[1];
priv->handle.private = priv;
priv->handle.dev = dev;
priv->handle.handler = handler;