opm.c revision 1.10 1 /* $NetBSD: opm.c,v 1.10 2002/10/02 16:02:42 thorpej Exp $ */
2
3 /*
4 * Copyright (c) 1995 Masanobu Saitoh, Takuya Harakawa.
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. All advertising materials mentioning features or use of this software
16 * must display the following acknowledgement:
17 * This product includes software developed by Masanobu Saitoh.
18 * 4. Neither the name of the University nor of the Laboratory may be used
19 * to endorse or promote products derived from this software without
20 * specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32 * SUCH DAMAGE.
33 */
34
35 /*
36 * Temporary implementation: not fully bus.h'fied.
37 */
38
39 #include <sys/param.h>
40 #include <sys/systm.h>
41 #include <sys/device.h>
42
43 #include <machine/bus.h>
44 #include <machine/cpu.h>
45
46 #include <arch/x68k/dev/opmreg.h>
47 #include <arch/x68k/dev/intiovar.h>
48
49 struct opm_softc {
50 struct device sc_dev;
51
52 bus_space_tag_t sc_bst;
53 bus_space_handle_t sc_bht;
54 u_int8_t sc_regs[0x100];
55 struct opm_voice sc_vdata[8];
56 };
57
58 struct opm_softc *opm0; /* XXX */
59
60 static int opm_match __P((struct device *, struct cfdata *, void *));
61 static void opm_attach __P((struct device *, struct device *, void *));
62
63 CFATTACH_DECL(opm, sizeof (struct opm_softc),
64 opm_match, opm_attach, NULL, NULL);
65
66 static int
67 opm_match(parent, cf, aux)
68 struct device *parent;
69 struct cfdata *cf;
70 void *aux;
71 {
72 struct intio_attach_args *ia = aux;
73
74 if (strcmp(ia->ia_name, "opm") != 0)
75 return 0;
76
77 if (ia->ia_addr == INTIOCF_ADDR_DEFAULT)
78 ia->ia_addr = 0xe90000;
79 ia->ia_size = 0x2000;
80 if (intio_map_allocate_region (parent, ia, INTIO_MAP_TESTONLY))
81 return 0;
82
83 return 1;
84 }
85
86 static void
87 opm_attach(parent, self, aux)
88 struct device *parent, *self;
89 void *aux;
90 {
91 struct opm_softc *sc = (struct opm_softc *)self;
92 struct intio_attach_args *ia = aux;
93 int r;
94
95 printf ("\n");
96 ia->ia_size = 0x2000;
97 r = intio_map_allocate_region (parent, ia, INTIO_MAP_ALLOCATE);
98 #ifdef DIAGNOSTIC
99 if (r)
100 panic ("IO map for OPM corruption??");
101 #endif
102
103 sc->sc_bst = ia->ia_bst;
104 r = bus_space_map (sc->sc_bst,
105 ia->ia_addr, ia->ia_size,
106 BUS_SPACE_MAP_SHIFTED,
107 &sc->sc_bht);
108 #ifdef DIAGNOSTIC
109 if (r)
110 panic ("Cannot map IO space for OPM.");
111 #endif
112
113 if (sc->sc_dev.dv_unit == 0)
114 opm0 = sc; /* XXX */
115
116 return;
117 }
118
119 void opm_set_volume __P((int, int));
120 void opm_set_key __P((int, int));
121 void opm_set_voice __P((int, struct opm_voice *));
122 void opm_set_voice_sub __P((int, struct opm_operator *));
123 __inline static void writeopm __P((int, int));
124 __inline static int readopm __P((int));
125 void opm_key_on __P((u_char));
126 void opm_key_off __P((u_char));
127 int opmopen __P((dev_t, int, int));
128 int opmclose __P((dev_t));
129
130 __inline static void
131 writeopm(reg, dat)
132 int reg, dat;
133 {
134 while (bus_space_read_1 (opm0->sc_bst, opm0->sc_bht, OPM_DATA) & 0x80);
135 bus_space_write_1 (opm0->sc_bst, opm0->sc_bht, OPM_REG, reg);
136 while (bus_space_read_1 (opm0->sc_bst, opm0->sc_bht, OPM_DATA) & 0x80);
137 bus_space_write_1 (opm0->sc_bst, opm0->sc_bht, OPM_DATA, dat);
138 opm0->sc_regs[reg] = dat;
139 }
140
141 __inline static int
142 readopm(reg)
143 int reg;
144 {
145 return opm0->sc_regs[reg];
146 }
147
148 #include "fd.h"
149 #include "vs.h"
150 #include "bell.h"
151
152 #if NVS > 0
153 void
154 adpcm_chgclk(clk)
155 u_char clk;
156 {
157 writeopm(0x1b, (readopm(0x1b) & ~OPM1B_CT1MSK) | clk);
158 }
159 #endif
160
161 #if NFD > 0
162 void
163 fdc_force_ready(rdy)
164 u_char rdy;
165 {
166 writeopm(0x1b, (readopm(0x1b) & ~OPM1B_CT2MSK) | rdy);
167 }
168 #endif
169
170 #if NBELL > 0
171 void
172 opm_key_on(channel)
173 u_char channel;
174 {
175 writeopm(0x08, opm0->sc_vdata[channel].sm << 3 | channel);
176 }
177
178 void
179 opm_key_off(channel)
180 u_char channel;
181 {
182 writeopm(0x08, channel);
183 }
184
185 void
186 opm_set_voice(channel, voice)
187 int channel;
188 struct opm_voice *voice;
189 {
190 memcpy(&opm0->sc_vdata[channel], voice, sizeof(struct opm_voice));
191
192 opm_set_voice_sub(0x40 + channel, &voice->m1);
193 opm_set_voice_sub(0x48 + channel, &voice->m2);
194 opm_set_voice_sub(0x50 + channel, &voice->c1);
195 opm_set_voice_sub(0x58 + channel, &voice->c2);
196 writeopm(0x20 + channel, 0xc0 | (voice->fb & 0x7) << 3 | (voice->con & 0x7));
197 }
198
199 void
200 opm_set_voice_sub(reg, op)
201 register int reg;
202 struct opm_operator *op;
203 {
204 /* DT1/MUL */
205 writeopm(reg, (op->dt1 & 0x7) << 3 | (op->mul & 0x7));
206
207 /* TL */
208 writeopm(reg + 0x20, op->tl & 0x7f);
209
210 /* KS/AR */
211 writeopm(reg + 0x40, (op->ks & 0x3) << 6 | (op->ar & 0x1f));
212
213 /* AMS/D1R */
214 writeopm(reg + 0x60, (op->ame & 0x1) << 7 | (op->d1r & 0x1f));
215
216 /* DT2/D2R */
217 writeopm(reg + 0x80, (op->dt2 & 0x3) << 6 | (op->d2r & 0x1f));
218
219 /* D1L/RR */
220 writeopm(reg + 0xa0, (op->d1l & 0xf) << 4 | (op->rr & 0xf));
221 }
222
223 void
224 opm_set_volume(channel, volume)
225 int channel;
226 int volume;
227 {
228 int value;
229
230 switch (opm0->sc_vdata[channel].con) {
231 case 7:
232 value = opm0->sc_vdata[channel].m1.tl + volume;
233 writeopm(0x60 + channel, ((value > 0x7f) ? 0x7f : value));
234 case 6:
235 case 5:
236 value = opm0->sc_vdata[channel].m2.tl + volume;
237 writeopm(0x68 + channel, ((value > 0x7f) ? 0x7f : value));
238 case 4:
239 value = opm0->sc_vdata[channel].c1.tl + volume;
240 writeopm(0x70 + channel, ((value > 0x7f) ? 0x7f : value));
241 case 3:
242 case 2:
243 case 1:
244 case 0:
245 value = opm0->sc_vdata[channel].c2.tl + volume;
246 writeopm(0x78 + channel, ((value > 0x7f) ? 0x7f : value));
247 }
248 }
249
250 void
251 opm_set_key(channel, tone)
252 int channel;
253 int tone;
254 {
255 writeopm(0x28 + channel, tone >> 8);
256 writeopm(0x30 + channel, tone & 0xff);
257 }
258
259 /*ARGSUSED*/
260 int
261 opmopen(dev, flag, mode)
262 dev_t dev;
263 int flag, mode;
264 {
265 return 0;
266 }
267
268 /*ARGSUSED*/
269 int
270 opmclose(dev)
271 dev_t dev;
272 {
273 return 0;
274 }
275
276 #endif
277