]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
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); |