linux-old/drivers/char/nwbutton.c
<<
>>
Prefs
   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
  27static int button_press_count;          /* The count of button presses */
  28static struct timer_list button_timer;  /* Times for the end of a sequence */ 
  29static DECLARE_WAIT_QUEUE_HEAD(button_wait_queue); /* Used for blocking read */
  30static char button_output_buffer[32];   /* Stores data to write out of device */
  31static int bcount;                      /* The number of bytes in the buffer */
  32static int bdelay = BUTTON_DELAY;       /* The delay, in jiffies */
  33static struct button_callback button_callback_list[32]; /* The callback list */
  34static int callback_count;              /* The number of callbacks registered */
  35static 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
  54int 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
  82int 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
 108static 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
 128static 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
 149static 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
 171static 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
 185static 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
 196static 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
 211static 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
 235static void __exit nwbutton_exit (void) 
 236{
 237        free_irq (IRQ_NETWINDER_BUTTON, NULL);
 238        misc_deregister (&button_misc_device);
 239}
 240
 241
 242MODULE_AUTHOR("Alex Holden");
 243MODULE_LICENSE("GPL");
 244EXPORT_NO_SYMBOLS;
 245
 246module_init(nwbutton_init);
 247module_exit(nwbutton_exit);
 248
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.