drivers/input/misc/sparcspkr.c

   1 /*
   2  *  Driver for PC-speaker like devices found on various Sparc systems.
   3  *
   4  *  Copyright (c) 2002 Vojtech Pavlik
   5  *  Copyright (c) 2002 David S. Miller (davem@redhat.com)
   6  */
   7 #include <linux/config.h>
   8 #include <linux/kernel.h>
   9 #include <linux/module.h>
  10 #include <linux/init.h>
  11 #include <linux/input.h>
  12
  13 #include <asm/io.h>
  14 #include <asm/ebus.h>
  15 #ifdef CONFIG_SPARC64
  16 #include <asm/isa.h>
  17 #endif
  18
  19 MODULE_AUTHOR("David S. Miller <davem@redhat.com>");
  20 MODULE_DESCRIPTION("PC Speaker beeper driver");
  21 MODULE_LICENSE("GPL");
  22
  23 static unsigned long beep_iobase;
  24
  25 static char *sparcspkr_isa_name = "Sparc ISA Speaker";
  26 static char *sparcspkr_ebus_name = "Sparc EBUS Speaker";
  27 static char *sparcspkr_phys = "sparc/input0";
  28 static struct input_dev sparcspkr_dev;
  29
  30 DEFINE_SPINLOCK(beep_lock);
  31
  32 static void __init init_sparcspkr_struct(void)
  33 {
  34         sparcspkr_dev.evbit[0] = BIT(EV_SND);
  35         sparcspkr_dev.sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE);
  36
  37         sparcspkr_dev.phys = sparcspkr_phys;
  38         sparcspkr_dev.id.bustype = BUS_ISA;
  39         sparcspkr_dev.id.vendor = 0x001f;
  40         sparcspkr_dev.id.product = 0x0001;
  41         sparcspkr_dev.id.version = 0x0100;
  42 }
  43
  44 static int ebus_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
  45 {
  46         unsigned int count = 0;
  47         unsigned long flags;
  48
  49         if (type != EV_SND)
  50                 return -1;
  51
  52         switch (code) {
  53                 case SND_BELL: if (value) value = 1000;
  54                 case SND_TONE: break;
  55                 default: return -1;
  56         }
  57
  58         if (value > 20 && value < 32767)
  59                 count = 1193182 / value;
  60
  61         spin_lock_irqsave(&beep_lock, flags);
  62
  63         /* EBUS speaker only has on/off state, the frequency does not
  64          * appear to be programmable.
  65          */
  66         if (count) {
  67                 if (beep_iobase & 0x2UL)
  68                         outb(1, beep_iobase);
  69                 else
  70                         outl(1, beep_iobase);
  71         } else {
  72                 if (beep_iobase & 0x2UL)
  73                         outb(0, beep_iobase);
  74                 else
  75                         outl(0, beep_iobase);
  76         }
  77
  78         spin_unlock_irqrestore(&beep_lock, flags);
  79
  80         return 0;
  81 }
  82
  83 static int __init init_ebus_beep(struct linux_ebus_device *edev)
  84 {
  85         beep_iobase = edev->resource[0].start;
  86
  87         init_sparcspkr_struct();
  88
  89         sparcspkr_dev.name = sparcspkr_ebus_name;
  90         sparcspkr_dev.event = ebus_spkr_event;
  91
  92         input_register_device(&sparcspkr_dev);
  93
  94         printk(KERN_INFO "input: %s\n", sparcspkr_ebus_name);
  95         return 0;
  96 }
  97
  98 #ifdef CONFIG_SPARC64
  99 static int isa_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
 100 {
 101         unsigned int count = 0;
 102         unsigned long flags;
 103
 104         if (type != EV_SND)
 105                 return -1;
 106
 107         switch (code) {
 108                 case SND_BELL: if (value) value = 1000;
 109                 case SND_TONE: break;
 110                 default: return -1;
 111         }
 112
 113         if (value > 20 && value < 32767)
 114                 count = 1193182 / value;
 115
 116         spin_lock_irqsave(&beep_lock, flags);
 117
 118         if (count) {
 119                 /* enable counter 2 */
 120                 outb(inb(beep_iobase + 0x61) | 3, beep_iobase + 0x61);
 121                 /* set command for counter 2, 2 byte write */
 122                 outb(0xB6, beep_iobase + 0x43);
 123                 /* select desired HZ */
 124                 outb(count & 0xff, beep_iobase + 0x42);
 125                 outb((count >> 8) & 0xff, beep_iobase + 0x42);
 126         } else {
 127                 /* disable counter 2 */
 128                 outb(inb_p(beep_iobase + 0x61) & 0xFC, beep_iobase + 0x61);
 129         }
 130
 131         spin_unlock_irqrestore(&beep_lock, flags);
 132
 133         return 0;
 134 }
 135
 136 static int __init init_isa_beep(struct sparc_isa_device *isa_dev)
 137 {
 138         beep_iobase = isa_dev->resource.start;
 139
 140         init_sparcspkr_struct();
 141
 142         sparcspkr_dev.name = sparcspkr_isa_name;
 143         sparcspkr_dev.event = isa_spkr_event;
 144         sparcspkr_dev.id.bustype = BUS_ISA;
 145
 146         input_register_device(&sparcspkr_dev);
 147
 148         printk(KERN_INFO "input: %s\n", sparcspkr_isa_name);
 149         return 0;
 150 }
 151 #endif
 152
 153 static int __init sparcspkr_init(void)
 154 {
 155         struct linux_ebus *ebus;
 156         struct linux_ebus_device *edev = NULL;
 157 #ifdef CONFIG_SPARC64
 158         struct sparc_isa_bridge *isa_br;
 159         struct sparc_isa_device *isa_dev;
 160 #endif
 161
 162         for_each_ebus(ebus) {
 163                 for_each_ebusdev(edev, ebus) {
 164                         if (!strcmp(edev->prom_name, "beep"))
 165                                 return init_ebus_beep(edev);
 166                 }
 167         }
 168 #ifdef CONFIG_SPARC64
 169         for_each_isa(isa_br) {
 170                 for_each_isadev(isa_dev, isa_br) {
 171                         /* A hack, the beep device's base lives in
 172                          * the DMA isa node.
 173                          */
 174                         if (!strcmp(isa_dev->prom_name, "dma"))
 175                                 return init_isa_beep(isa_dev);
 176                 }
 177         }
 178 #endif
 179
 180         return -ENODEV;
 181 }
 182
 183 static void __exit sparcspkr_exit(void)
 184 {
 185         input_unregister_device(&sparcspkr_dev);
 186 }
 187
 188 module_init(sparcspkr_init);
 189 module_exit(sparcspkr_exit);