[PATCH] drivers/input/mouse: convert to dynamic input_dev allocation
[linux-2.6.git] / 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);