ath: open up a few safe 5ghz channels in the world regdomain to make the regulatory...

[openwrt.git] / package / button-hotplug / src / button-hotplug.c

diff --git a/package/button-hotplug/src/button-hotplug.c b/package/button-hotplug/src/button-hotplug.c
index 3b5527f..4a8c4a8 100644 (file)
--- a/package/button-hotplug/src/button-hotplug.c
+++ b/package/button-hotplug/src/button-hotplug.c
@@ -1,7 +1,7 @@
 /*
  *  Button Hotplug driver
  *
 /*
  *  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>,
  *
  *  Based on the diag.c - GPIO interface driver for Broadcom boards
  *    Copyright (C) 2006 Mike Baker <mbm@openwrt.org>,


@@ -21,38 +21,37 @@
 #include <linux/workqueue.h>
 #include <linux/skbuff.h>
 #include <linux/netlink.h>
 #include <linux/workqueue.h>
 #include <linux/skbuff.h>
 #include <linux/netlink.h>

-#include <net/sock.h>
+#include <linux/kobject.h>

 
 #define DRV_NAME       "button-hotplug"
 
 #define DRV_NAME       "button-hotplug"

-#define DRV_VERSION    "0.3.0"
+#define DRV_VERSION    "0.4.1"

 #define DRV_DESC       "Button Hotplug driver"
 
 #define BH_SKB_SIZE    2048
 
 #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 ": "
 
 #define PFX    DRV_NAME ": "
 

-/*#define BH_DEBUG*/
+#undef BH_DEBUG

 
 #ifdef BH_DEBUG
 
 #ifdef BH_DEBUG

-#define BH_DBG(fmt, args...) printk(KERN_DEBUG "%s" fmt, ##args )
+#define BH_DBG(fmt, args...) printk(KERN_DEBUG "%s: " fmt, DRV_NAME, ##args )

 #else
 #define BH_DBG(fmt, args...) do {} while (0)
 #endif
 
 #else
 #define BH_DBG(fmt, args...) do {} while (0)
 #endif
 

-#define BH_ERR(fmt, args...) printk(KERN_ERR "%s" fmt, ##args )
+#define BH_ERR(fmt, args...) printk(KERN_ERR "%s: " fmt, DRV_NAME, ##args )
+
+#ifndef BIT_MASK
+#define BIT_MASK(nr)            (1UL << ((nr) % BITS_PER_LONG))
+#endif

 
 struct bh_priv {
 
 struct bh_priv {

-       unsigned long           seen[BH_BTN_COUNT];
+       unsigned long           *seen;

        struct input_handle     handle;
 };
 
 struct bh_event {
        struct input_handle     handle;
 };
 
 struct bh_event {

-       char                    *name;
+       const char              *name;

        char                    *action;
        unsigned long           seen;
 
        char                    *action;
        unsigned long           seen;
 


@@ -60,12 +59,34 @@ struct bh_event {
        struct work_struct      work;
 };
 
        struct work_struct      work;
 };
 

-extern struct sock *uevent_sock;
+struct bh_map {
+       unsigned int    code;
+       const char      *name;
+};
+

 extern u64 uevent_next_seqnum(void);
 
 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 */

 };
 
 /* -------------------------------------------------------------------------*/
 };
 
 /* -------------------------------------------------------------------------*/


@@ -138,9 +159,6 @@ static void button_hotplug_work(struct work_struct *work)
        struct bh_event *event = container_of(work, struct bh_event, work);
        int ret = 0;
 
        struct bh_event *event = container_of(work, struct bh_event, work);
        int ret = 0;
 

-       if (!uevent_sock)
-               goto out_free_event;
-

        event->skb = alloc_skb(BH_SKB_SIZE, GFP_KERNEL);
        if (!event->skb)
                goto out_free_event;
        event->skb = alloc_skb(BH_SKB_SIZE, GFP_KERNEL);
        if (!event->skb)
                goto out_free_event;


@@ -154,7 +172,7 @@ static void button_hotplug_work(struct work_struct *work)
                goto out_free_skb;
 
        NETLINK_CB(event->skb).dst_group = 1;
                goto out_free_skb;
 
        NETLINK_CB(event->skb).dst_group = 1;

-       netlink_broadcast(uevent_sock, event->skb, 0, 1, GFP_KERNEL);
+       broadcast_uevent(event->skb, 0, 1, GFP_KERNEL);

 
  out_free_skb:
        if (ret) {
 
  out_free_skb:
        if (ret) {


@@ -165,7 +183,7 @@ static void button_hotplug_work(struct work_struct *work)
        kfree(event);
 }
 
        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;
                int pressed)
 {
        struct bh_event *event;


@@ -190,23 +208,33 @@ static int button_hotplug_create_event(char *name, unsigned long seen,
 /* -------------------------------------------------------------------------*/
 
 #ifdef CONFIG_HOTPLUG
 /* -------------------------------------------------------------------------*/
 
 #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;
 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;
 
 
        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;
 
                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;
 }
                        (seen - priv->seen[btn]) / HZ, value);
        priv->seen[btn] = seen;
 }


@@ -224,17 +252,20 @@ static int button_hotplug_connect(struct input_handler *handler,
        int ret;
        int i;
 
        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;
 
                        break;
 

-       if (i > BH_BTN_MAX)
+       if (i == ARRAY_SIZE(button_map))

                return -ENODEV;
 
                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;
 
        if (!priv)
                return -ENOMEM;
 

+       priv->seen = (unsigned long *) &priv[1];

        priv->handle.private = priv;
        priv->handle.dev = dev;
        priv->handle.handler = handler;
        priv->handle.private = priv;
        priv->handle.dev = dev;
        priv->handle.handler = handler;