sparcspkr.c 3.95 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
/*
 *  Driver for PC-speaker like devices found on various Sparc systems.
 *
 *  Copyright (c) 2002 Vojtech Pavlik
 *  Copyright (c) 2002 David S. Miller (davem@redhat.com)
 */
#include <linux/config.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/input.h>

#include <asm/io.h>
#include <asm/ebus.h>
#ifdef CONFIG_SPARC64
#include <asm/isa.h>
#endif

MODULE_AUTHOR("David S. Miller <davem@redhat.com>");
20
MODULE_DESCRIPTION("Sparc Speaker beeper driver");
Linus Torvalds's avatar
Linus Torvalds committed
21
22
23
MODULE_LICENSE("GPL");

static unsigned long beep_iobase;
24
static struct input_dev *sparcspkr_dev;
Linus Torvalds's avatar
Linus Torvalds committed
25
26
27
28
29

DEFINE_SPINLOCK(beep_lock);

static void __init init_sparcspkr_struct(void)
{
30
31
32
33
34
35
36
37
	sparcspkr_dev->evbit[0] = BIT(EV_SND);
	sparcspkr_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE);

	sparcspkr_dev->phys = "sparc/input0";
	sparcspkr_dev->id.bustype = BUS_ISA;
	sparcspkr_dev->id.vendor = 0x001f;
	sparcspkr_dev->id.product = 0x0001;
	sparcspkr_dev->id.version = 0x0100;
Linus Torvalds's avatar
Linus Torvalds committed
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
}

static int ebus_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
{
	unsigned int count = 0;
	unsigned long flags;

	if (type != EV_SND)
		return -1;

	switch (code) {
		case SND_BELL: if (value) value = 1000;
		case SND_TONE: break;
		default: return -1;
	}

	if (value > 20 && value < 32767)
		count = 1193182 / value;

	spin_lock_irqsave(&beep_lock, flags);

	/* EBUS speaker only has on/off state, the frequency does not
	 * appear to be programmable.
	 */
	if (count) {
		if (beep_iobase & 0x2UL)
			outb(1, beep_iobase);
		else
			outl(1, beep_iobase);
	} else {
		if (beep_iobase & 0x2UL)
			outb(0, beep_iobase);
		else
			outl(0, beep_iobase);
	}

	spin_unlock_irqrestore(&beep_lock, flags);

	return 0;
}

static int __init init_ebus_beep(struct linux_ebus_device *edev)
{
	beep_iobase = edev->resource[0].start;

83
84
85
	sparcspkr_dev = input_allocate_device();
	if (!sparcspkr_dev)
		return -ENOMEM;
Linus Torvalds's avatar
Linus Torvalds committed
86

87
88
	sparcspkr_dev->name = "Sparc EBUS Speaker";
	sparcspkr_dev->event = ebus_spkr_event;
Linus Torvalds's avatar
Linus Torvalds committed
89

90
	input_register_device(sparcspkr_dev);
Linus Torvalds's avatar
Linus Torvalds committed
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136

	return 0;
}

#ifdef CONFIG_SPARC64
static int isa_spkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
{
	unsigned int count = 0;
	unsigned long flags;

	if (type != EV_SND)
		return -1;

	switch (code) {
		case SND_BELL: if (value) value = 1000;
		case SND_TONE: break;
		default: return -1;
	}

	if (value > 20 && value < 32767)
		count = 1193182 / value;

	spin_lock_irqsave(&beep_lock, flags);

	if (count) {
		/* enable counter 2 */
		outb(inb(beep_iobase + 0x61) | 3, beep_iobase + 0x61);
		/* set command for counter 2, 2 byte write */
		outb(0xB6, beep_iobase + 0x43);
		/* select desired HZ */
		outb(count & 0xff, beep_iobase + 0x42);
		outb((count >> 8) & 0xff, beep_iobase + 0x42);
	} else {
		/* disable counter 2 */
		outb(inb_p(beep_iobase + 0x61) & 0xFC, beep_iobase + 0x61);
	}

	spin_unlock_irqrestore(&beep_lock, flags);

	return 0;
}

static int __init init_isa_beep(struct sparc_isa_device *isa_dev)
{
	beep_iobase = isa_dev->resource.start;

137
138
139
140
	sparcspkr_dev = input_allocate_device();
	if (!sparcspkr_dev)
		return -ENOMEM;

Linus Torvalds's avatar
Linus Torvalds committed
141
142
	init_sparcspkr_struct();

143
144
	sparcspkr_dev->name = "Sparc ISA Speaker";
	sparcspkr_dev->event = isa_spkr_event;
Linus Torvalds's avatar
Linus Torvalds committed
145

146
	input_register_device(sparcspkr_dev);
Linus Torvalds's avatar
Linus Torvalds committed
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183

	return 0;
}
#endif

static int __init sparcspkr_init(void)
{
	struct linux_ebus *ebus;
	struct linux_ebus_device *edev = NULL;
#ifdef CONFIG_SPARC64
	struct sparc_isa_bridge *isa_br;
	struct sparc_isa_device *isa_dev;
#endif

	for_each_ebus(ebus) {
		for_each_ebusdev(edev, ebus) {
			if (!strcmp(edev->prom_name, "beep"))
				return init_ebus_beep(edev);
		}
	}
#ifdef CONFIG_SPARC64
	for_each_isa(isa_br) {
		for_each_isadev(isa_dev, isa_br) {
			/* A hack, the beep device's base lives in
			 * the DMA isa node.
			 */
			if (!strcmp(isa_dev->prom_name, "dma"))
				return init_isa_beep(isa_dev);
		}
	}
#endif

	return -ENODEV;
}

static void __exit sparcspkr_exit(void)
{
184
	input_unregister_device(sparcspkr_dev);
Linus Torvalds's avatar
Linus Torvalds committed
185
186
187
188
}

module_init(sparcspkr_init);
module_exit(sparcspkr_exit);