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);
190
|
This page was automatically generated by the
LXR engine.
|