d62c5e1c4efe0a1ee7c49a8e07b2f4c07f4cc9af
[openwrt/svn-archive/archive.git] / target / linux / atheros-2.6 / files / arch / mips / atheros / reset.c
1 #include <linux/module.h>
2 #include <linux/timer.h>
3 #include <linux/interrupt.h>
4 #include <linux/kobject.h>
5 #include <linux/workqueue.h>
6 #include <linux/skbuff.h>
7 #include <linux/netlink.h>
8 #include <net/sock.h>
9 #include <asm/uaccess.h>
10 #include "ar531x.h"
11 #include "ar5315/ar5315.h"
12
13 struct event_t {
14 struct work_struct wq;
15 int set;
16 long int jiffies;
17 };
18
19 extern struct sock *uevent_sock;
20 extern u64 uevent_next_seqnum(void);
21 static int seen;
22
23 static inline void add_msg(struct sk_buff *skb, char *msg)
24 {
25 char *scratch;
26 scratch = skb_put(skb, strlen(msg) + 1);
27 sprintf(scratch, msg);
28 }
29
30 static void hotplug_button(struct work_struct *wq)
31 {
32 struct sk_buff *skb;
33 struct event_t *event;
34 size_t len;
35 char *scratch, *s;
36 char buf[128];
37
38 event = container_of(wq, struct event_t, wq);
39 if (!uevent_sock)
40 goto done;
41
42 /* allocate message with the maximum possible size */
43 s = event->set ? "pressed" : "released";
44 len = strlen(s) + 2;
45 skb = alloc_skb(len + 2048, GFP_KERNEL);
46 if (!skb)
47 goto done;
48
49 /* add header */
50 scratch = skb_put(skb, len);
51 sprintf(scratch, "%s@",s);
52
53 /* copy keys to our continuous event payload buffer */
54 add_msg(skb, "HOME=/");
55 add_msg(skb, "PATH=/sbin:/bin:/usr/sbin:/usr/bin");
56 add_msg(skb, "SUBSYSTEM=button");
57 add_msg(skb, "BUTTON=reset");
58 add_msg(skb, (event->set ? "ACTION=pressed" : "ACTION=released"));
59 sprintf(buf, "SEEN=%ld", (event->jiffies - seen)/HZ);
60 add_msg(skb, buf);
61 snprintf(buf, 128, "SEQNUM=%llu", uevent_next_seqnum());
62 add_msg(skb, buf);
63
64 NETLINK_CB(skb).dst_group = 1;
65 netlink_broadcast(uevent_sock, skb, 0, 1, GFP_KERNEL);
66
67 done:
68 kfree(event);
69 }
70
71 static irqreturn_t button_handler(int irq, void *dev_id)
72 {
73 static int pressed = 0;
74 struct event_t *event;
75 u32 gpio = ~0;
76
77 event = (struct event_t *) kzalloc(sizeof(struct event_t), GFP_ATOMIC);
78 if (!event)
79 return IRQ_NONE;
80
81 pressed = !pressed;
82
83 DO_AR5315(gpio = sysRegRead(AR5315_GPIO_DI);)
84 gpio &= 1 << (irq - AR531X_GPIO_IRQ_BASE);
85
86 event->set = gpio;
87 event->jiffies = jiffies;
88
89 INIT_WORK(&event->wq, (void *)(void *)hotplug_button);
90 schedule_work(&event->wq);
91
92 seen = jiffies;
93
94 return IRQ_HANDLED;
95 }
96
97 int __init ar531x_init_reset(void)
98 {
99 struct ar531x_boarddata *bcfg;
100 bcfg = (struct ar531x_boarddata *) board_config;
101
102 seen = jiffies;
103 request_irq(AR531X_GPIO_IRQ_BASE + bcfg->resetConfigGpio, &button_handler, IRQF_SAMPLE_RANDOM, "ar531x_reset", NULL);
104
105 return 0;
106 }
107
108 module_init(ar531x_init_reset);