tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
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
19MODULE_AUTHOR("David S. Miller <davem@redhat.com>");
20MODULE_DESCRIPTION("PC Speaker beeper driver");
21MODULE_LICENSE("GPL");
22
23static unsigned long beep_iobase;
24
25static char *sparcspkr_isa_name = "Sparc ISA Speaker";
26static char *sparcspkr_ebus_name = "Sparc EBUS Speaker";
27static char *sparcspkr_phys = "sparc/input0";
28static struct input_dev sparcspkr_dev;
29
30DEFINE_SPINLOCK(beep_lock);
31
32static 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
44static 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
83static 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
99static 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
136static 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
153static 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
183static void __exit sparcspkr_exit(void)
184{
185 input_unregister_device(&sparcspkr_dev);
186}
187
188module_init(sparcspkr_init);
189module_exit(sparcspkr_exit);