1 /*
2 * NetWinder Button Driver-
3 * Copyright (C) Alex Holden <alex@linuxhacker.org> 1998, 1999.
4 *
5 */
6
7 #include <linux/config.h>
8 #include <linux/module.h>
9 #include <linux/kernel.h>
10 #include <linux/sched.h>
11 #include <linux/interrupt.h>
12 #include <linux/time.h>
13 #include <linux/timer.h>
14 #include <linux/fs.h>
15 #include <linux/miscdevice.h>
16 #include <linux/string.h>
17 #include <linux/errno.h>
18 #include <linux/init.h>
19
20 #include <asm/uaccess.h>
21 #include <asm/irq.h>
22 #include <asm/mach-types.h>
23
24 #define __NWBUTTON_C /* Tell the header file who we are */
25 #include "nwbutton.h"
26
27 static int button_press_count; /* The count of button presses */
28 static struct timer_list button_timer; /* Times for the end of a sequence */
29 static DECLARE_WAIT_QUEUE_HEAD(button_wait_queue); /* Used for blocking read */
30 static char button_output_buffer[32]; /* Stores data to write out of device */
31 static int bcount; /* The number of bytes in the buffer */
32 static int bdelay = BUTTON_DELAY; /* The delay, in jiffies */
33 static struct button_callback button_callback_list[32]; /* The callback list */
34 static int callback_count; /* The number of callbacks registered */
35 static int reboot_count = NUM_PRESSES_REBOOT; /* Number of presses to reboot */
36
37 /*
38 * This function is called by other drivers to register a callback function
39 * to be called when a particular number of button presses occurs.
40 * The callback list is a static array of 32 entries (I somehow doubt many
41 * people are ever going to want to register more than 32 different actions
42 * to be performed by the kernel on different numbers of button presses ;).
43 * However, if an attempt to register a 33rd entry (perhaps a stuck loop
44 * somewhere registering the same entry over and over?) it will fail to
45 * do so and return -ENOMEM. If an attempt is made to register a null pointer,
46 * it will fail to do so and return -EINVAL.
47 * Because callbacks can be unregistered at random the list can become
48 * fragmented, so we need to search through the list until we find the first
49 * free entry.
50 *
51 * FIXME: Has anyone spotted any locking functions int his code recently ??
52 */
53
button_add_callback(void (* callback)(void),int count)54 int button_add_callback (void (*callback) (void), int count)
55 {
56 int lp = 0;
57 if (callback_count == 32) {
58 return -ENOMEM;
59 }
60 if (!callback) {
61 return -EINVAL;
62 }
63 callback_count++;
64 for (; (button_callback_list [lp].callback); lp++);
65 button_callback_list [lp].callback = callback;
66 button_callback_list [lp].count = count;
67 return 0;
68 }
69
70 /*
71 * This function is called by other drivers to deregister a callback function.
72 * If you attempt to unregister a callback which does not exist, it will fail
73 * with -EINVAL. If there is more than one entry with the same address,
74 * because it searches the list from end to beginning, it will unregister the
75 * last one to be registered first (FILO- First In Last Out).
76 * Note that this is not neccessarily true if the entries are not submitted
77 * at the same time, because another driver could have unregistered a callback
78 * between the submissions creating a gap earlier in the list, which would
79 * be filled first at submission time.
80 */
81
button_del_callback(void (* callback)(void))82 int button_del_callback (void (*callback) (void))
83 {
84 int lp = 31;
85 if (!callback) {
86 return -EINVAL;
87 }
88 while (lp >= 0) {
89 if ((button_callback_list [lp].callback) == callback) {
90 button_callback_list [lp].callback = NULL;
91 button_callback_list [lp].count = 0;
92 callback_count--;
93 return 0;
94 };
95 lp--;
96 };
97 return -EINVAL;
98 }
99
100 /*
101 * This function is called by button_sequence_finished to search through the
102 * list of callback functions, and call any of them whose count argument
103 * matches the current count of button presses. It starts at the beginning
104 * of the list and works up to the end. It will refuse to follow a null
105 * pointer (which should never happen anyway).
106 */
107
button_consume_callbacks(int bpcount)108 static void button_consume_callbacks (int bpcount)
109 {
110 int lp = 0;
111 for (; lp <= 31; lp++) {
112 if ((button_callback_list [lp].count) == bpcount) {
113 if (button_callback_list [lp].callback) {
114 button_callback_list[lp].callback();
115 }
116 }
117 }
118 }
119
120 /*
121 * This function is called when the button_timer times out.
122 * ie. When you don't press the button for bdelay jiffies, this is taken to
123 * mean you have ended the sequence of key presses, and this function is
124 * called to wind things up (write the press_count out to /dev/button, call
125 * any matching registered function callbacks, initiate reboot, etc.).
126 */
127
button_sequence_finished(unsigned long parameters)128 static void button_sequence_finished (unsigned long parameters)
129 {
130 #ifdef CONFIG_NWBUTTON_REBOOT /* Reboot using button is enabled */
131 if (button_press_count == reboot_count) {
132 kill_proc (1, SIGINT, 1); /* Ask init to reboot us */
133 }
134 #endif /* CONFIG_NWBUTTON_REBOOT */
135 button_consume_callbacks (button_press_count);
136 bcount = sprintf (button_output_buffer, "%d\n", button_press_count);
137 button_press_count = 0; /* Reset the button press counter */
138 wake_up_interruptible (&button_wait_queue);
139 }
140
141 /*
142 * This handler is called when the orange button is pressed (GPIO 10 of the
143 * SuperIO chip, which maps to logical IRQ 26). If the press_count is 0,
144 * this is the first press, so it starts a timer and increments the counter.
145 * If it is higher than 0, it deletes the old timer, starts a new one, and
146 * increments the counter.
147 */
148
button_handler(int irq,void * dev_id,struct pt_regs * regs)149 static void button_handler (int irq, void *dev_id, struct pt_regs *regs)
150 {
151 if (button_press_count) {
152 del_timer (&button_timer);
153 }
154 button_press_count++;
155 init_timer (&button_timer);
156 button_timer.function = button_sequence_finished;
157 button_timer.expires = (jiffies + bdelay);
158 add_timer (&button_timer);
159 }
160
161 /*
162 * This function is called when a user space program attempts to read
163 * /dev/nwbutton. It puts the device to sleep on the wait queue until
164 * button_sequence_finished writes some data to the buffer and flushes
165 * the queue, at which point it writes the data out to the device and
166 * returns the number of characters it has written. This function is
167 * reentrant, so that many processes can be attempting to read from the
168 * device at any one time.
169 */
170
button_read(struct file * filp,char * buffer,size_t count,loff_t * ppos)171 static int button_read (struct file *filp, char *buffer,
172 size_t count, loff_t *ppos)
173 {
174 interruptible_sleep_on (&button_wait_queue);
175 return (copy_to_user (buffer, &button_output_buffer, bcount))
176 ? -EFAULT : bcount;
177 }
178
179 /*
180 * This structure is the file operations structure, which specifies what
181 * callbacks functions the kernel should call when a user mode process
182 * attempts to perform these operations on the device.
183 */
184
185 static struct file_operations button_fops = {
186 owner: THIS_MODULE,
187 read: button_read,
188 };
189
190 /*
191 * This structure is the misc device structure, which specifies the minor
192 * device number (158 in this case), the name of the device (for /proc/misc),
193 * and the address of the above file operations structure.
194 */
195
196 static struct miscdevice button_misc_device = {
197 BUTTON_MINOR,
198 "nwbutton",
199 &button_fops,
200 };
201
202 /*
203 * This function is called to initialise the driver, either from misc.c at
204 * bootup if the driver is compiled into the kernel, or from init_module
205 * below at module insert time. It attempts to register the device node
206 * and the IRQ and fails with a warning message if either fails, though
207 * neither ever should because the device number and IRQ are unique to
208 * this driver.
209 */
210
nwbutton_init(void)211 static int __init nwbutton_init(void)
212 {
213 if (!machine_is_netwinder())
214 return -ENODEV;
215
216 printk (KERN_INFO "NetWinder Button Driver Version %s (C) Alex Holden "
217 "<alex@linuxhacker.org> 1998.\n", VERSION);
218
219 if (misc_register (&button_misc_device)) {
220 printk (KERN_WARNING "nwbutton: Couldn't register device 10, "
221 "%d.\n", BUTTON_MINOR);
222 return -EBUSY;
223 }
224
225 if (request_irq (IRQ_NETWINDER_BUTTON, button_handler, SA_INTERRUPT,
226 "nwbutton", NULL)) {
227 printk (KERN_WARNING "nwbutton: IRQ %d is not free.\n",
228 IRQ_NETWINDER_BUTTON);
229 misc_deregister (&button_misc_device);
230 return -EIO;
231 }
232 return 0;
233 }
234
nwbutton_exit(void)235 static void __exit nwbutton_exit (void)
236 {
237 free_irq (IRQ_NETWINDER_BUTTON, NULL);
238 misc_deregister (&button_misc_device);
239 }
240
241
242 MODULE_AUTHOR("Alex Holden");
243 MODULE_LICENSE("GPL");
244 EXPORT_NO_SYMBOLS;
245
246 module_init(nwbutton_init);
247 module_exit(nwbutton_exit);
248