drivers/input/misc/m68kspkr.c

   1 /*
   2  *  m68k beeper driver for Linux
   3  *
   4  *  Copyright (c) 2002 Richard Zidlicky
   5  *  Copyright (c) 2002 Vojtech Pavlik
   6  *  Copyright (c) 1992 Orest Zborowski
   7  *
   8  */
   9
  10 /*
  11  * This program is free software; you can redistribute it and/or modify it
  12  * under the terms of the GNU General Public License version 2 as published by
  13  * the Free Software Foundation
  14  */
  15
  16 #include <linux/kernel.h>
  17 #include <linux/module.h>
  18 #include <linux/init.h>
  19 #include <linux/input.h>
  20 #include <linux/platform_device.h>
  21 #include <asm/machdep.h>
  22 #include <asm/io.h>
  23
  24 MODULE_AUTHOR("Richard Zidlicky <rz@linux-m68k.org>");
  25 MODULE_DESCRIPTION("m68k beeper driver");
  26 MODULE_LICENSE("GPL");
  27
  28 static struct platform_device *m68kspkr_platform_device;
  29
  30 static int m68kspkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
  31 {
  32         unsigned int count = 0;
  33
  34         if (type != EV_SND)
  35                 return -1;
  36
  37         switch (code) {
  38                 case SND_BELL: if (value) value = 1000;
  39                 case SND_TONE: break;
  40                 default: return -1;
  41         }
  42
  43         if (value > 20 && value < 32767)
  44                 count = 1193182 / value;
  45
  46         mach_beep(count, -1);
  47
  48         return 0;
  49 }
  50
  51 static int m68kspkr_probe(struct platform_device *dev)
  52 {
  53         struct input_dev *input_dev;
  54         int err;
  55
  56         input_dev = input_allocate_device();
  57         if (!input_dev)
  58                 return -ENOMEM;
  59
  60         input_dev->name = "m68k beeper";
  61         input_dev->phys = "m68k/generic";
  62         input_dev->id.bustype = BUS_HOST;
  63         input_dev->id.vendor  = 0x001f;
  64         input_dev->id.product = 0x0001;
  65         input_dev->id.version = 0x0100;
  66         input_dev->dev.parent = &dev->dev;
  67
  68         input_dev->evbit[0] = BIT_MASK(EV_SND);
  69         input_dev->sndbit[0] = BIT_MASK(SND_BELL) | BIT_MASK(SND_TONE);
  70         input_dev->event = m68kspkr_event;
  71
  72         err = input_register_device(input_dev);
  73         if (err) {
  74                 input_free_device(input_dev);
  75                 return err;
  76         }
  77
  78         platform_set_drvdata(dev, input_dev);
  79
  80         return 0;
  81 }
  82
  83 static int m68kspkr_remove(struct platform_device *dev)
  84 {
  85         struct input_dev *input_dev = platform_get_drvdata(dev);
  86
  87         input_unregister_device(input_dev);
  88         /* turn off the speaker */
  89         m68kspkr_event(NULL, EV_SND, SND_BELL, 0);
  90
  91         return 0;
  92 }
  93
  94 static void m68kspkr_shutdown(struct platform_device *dev)
  95 {
  96         /* turn off the speaker */
  97         m68kspkr_event(NULL, EV_SND, SND_BELL, 0);
  98 }
  99
 100 static struct platform_driver m68kspkr_platform_driver = {
 101         .driver         = {
 102                 .name   = "m68kspkr",
 103                 .owner  = THIS_MODULE,
 104         },
 105         .probe          = m68kspkr_probe,
 106         .remove         = m68kspkr_remove,
 107         .shutdown       = m68kspkr_shutdown,
 108 };
 109
 110 static int __init m68kspkr_init(void)
 111 {
 112         int err;
 113
 114         if (!mach_beep) {
 115                 printk(KERN_INFO "m68kspkr: no lowlevel beep support\n");
 116                 return -ENODEV;
 117         }
 118
 119         err = platform_driver_register(&m68kspkr_platform_driver);
 120         if (err)
 121                 return err;
 122
 123         m68kspkr_platform_device = platform_device_alloc("m68kspkr", -1);
 124         if (!m68kspkr_platform_device) {
 125                 err = -ENOMEM;
 126                 goto err_unregister_driver;
 127         }
 128
 129         err = platform_device_add(m68kspkr_platform_device);
 130         if (err)
 131                 goto err_free_device;
 132
 133         return 0;
 134
 135  err_free_device:
 136         platform_device_put(m68kspkr_platform_device);
 137  err_unregister_driver:
 138         platform_driver_unregister(&m68kspkr_platform_driver);
 139
 140         return err;
 141 }
 142
 143 static void __exit m68kspkr_exit(void)
 144 {
 145         platform_device_unregister(m68kspkr_platform_device);
 146         platform_driver_unregister(&m68kspkr_platform_driver);
 147 }
 148
 149 module_init(m68kspkr_init);
 150 module_exit(m68kspkr_exit);