1 /* $NetBSD: opm.c,v 1.14 2005/12/11 12:19:37 christos 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/cdefs.h> 40 __KERNEL_RCSID(0, "$NetBSD: opm.c,v 1.14 2005/12/11 12:19:37 christos Exp $"); 41 42 #include <sys/param.h> 43 #include <sys/systm.h> 44 #include <sys/device.h> 45 46 #include <machine/bus.h> 47 #include <machine/cpu.h> 48 49 #include <machine/opmreg.h> 50 #include <arch/x68k/dev/opmvar.h> 51 #include <arch/x68k/dev/intiovar.h> 52 53 struct opm_softc { 54 struct device sc_dev; 55 56 bus_space_tag_t sc_bst; 57 bus_space_handle_t sc_bht; 58 u_int8_t sc_regs[0x100]; 59 struct opm_voice sc_vdata[8]; 60 }; 61 62 struct opm_softc *opm0; /* XXX */ 63 64 static int opm_match(struct device *, struct cfdata *, void *); 65 static void opm_attach(struct device *, struct device *, void *); 66 67 CFATTACH_DECL(opm, sizeof (struct opm_softc), 68 opm_match, opm_attach, NULL, NULL); 69 70 static int 71 opm_match(struct device *parent, struct cfdata *cf, void *aux) 72 { 73 struct intio_attach_args *ia = aux; 74 75 if (strcmp(ia->ia_name, "opm") != 0) 76 return 0; 77 78 if (ia->ia_addr == INTIOCF_ADDR_DEFAULT) 79 ia->ia_addr = 0xe90000; 80 ia->ia_size = 0x2000; 81 if (intio_map_allocate_region (parent, ia, INTIO_MAP_TESTONLY)) 82 return 0; 83 84 return 1; 85 } 86 87 static void 88 opm_attach(struct device *parent, struct device *self, void *aux) 89 { 90 struct opm_softc *sc = (struct opm_softc *)self; 91 struct intio_attach_args *ia = aux; 92 int r; 93 94 printf ("\n"); 95 ia->ia_size = 0x2000; 96 r = intio_map_allocate_region (parent, ia, INTIO_MAP_ALLOCATE); 97 #ifdef DIAGNOSTIC 98 if (r) 99 panic ("IO map for OPM corruption??"); 100 #endif 101 102 sc->sc_bst = ia->ia_bst; 103 r = bus_space_map (sc->sc_bst, 104 ia->ia_addr, ia->ia_size, 105 BUS_SPACE_MAP_SHIFTED, 106 &sc->sc_bht); 107 #ifdef DIAGNOSTIC 108 if (r) 109 panic ("Cannot map IO space for OPM."); 110 #endif 111 112 if (sc->sc_dev.dv_unit == 0) 113 opm0 = sc; /* XXX */ 114 115 return; 116 } 117 118 void opm_set_volume(int, int); 119 void opm_set_key(int, int); 120 void opm_set_voice(int, struct opm_voice *); 121 void opm_set_voice_sub(int, struct opm_operator *); 122 __inline static void writeopm(int, int); 123 __inline static int readopm(int); 124 void opm_key_on(u_char); 125 void opm_key_off(u_char); 126 int opmopen(dev_t, int, int); 127 int opmclose(dev_t); 128 129 __inline static void 130 writeopm(int reg, int dat) 131 { 132 while (bus_space_read_1 (opm0->sc_bst, opm0->sc_bht, OPM_DATA) & 0x80); 133 bus_space_write_1 (opm0->sc_bst, opm0->sc_bht, OPM_REG, reg); 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_DATA, dat); 136 opm0->sc_regs[reg] = dat; 137 } 138 139 __inline static int 140 readopm(int reg) 141 { 142 return opm0->sc_regs[reg]; 143 } 144 145 #include "fd.h" 146 #include "vs.h" 147 #include "bell.h" 148 149 #if NVS > 0 150 void 151 adpcm_chgclk(u_char clk) 152 { 153 writeopm(0x1b, (readopm(0x1b) & ~OPM1B_CT1MSK) | clk); 154 } 155 #endif 156 157 #if NFD > 0 158 void 159 fdc_force_ready(u_char rdy) 160 { 161 writeopm(0x1b, (readopm(0x1b) & ~OPM1B_CT2MSK) | rdy); 162 } 163 #endif 164 165 #if NBELL > 0 166 void 167 opm_key_on(u_char channel) 168 { 169 writeopm(0x08, opm0->sc_vdata[channel].sm << 3 | channel); 170 } 171 172 void 173 opm_key_off(u_char channel) 174 { 175 writeopm(0x08, channel); 176 } 177 178 void 179 opm_set_voice(int channel, struct opm_voice *voice) 180 { 181 memcpy(&opm0->sc_vdata[channel], voice, sizeof(struct opm_voice)); 182 183 opm_set_voice_sub(0x40 + channel, &voice->m1); 184 opm_set_voice_sub(0x48 + channel, &voice->m2); 185 opm_set_voice_sub(0x50 + channel, &voice->c1); 186 opm_set_voice_sub(0x58 + channel, &voice->c2); 187 writeopm(0x20 + channel, 0xc0 | (voice->fb & 0x7) << 3 | 188 (voice->con & 0x7)); 189 } 190 191 void 192 opm_set_voice_sub(int reg, struct opm_operator *op) 193 { 194 /* DT1/MUL */ 195 writeopm(reg, (op->dt1 & 0x7) << 3 | (op->mul & 0x7)); 196 197 /* TL */ 198 writeopm(reg + 0x20, op->tl & 0x7f); 199 200 /* KS/AR */ 201 writeopm(reg + 0x40, (op->ks & 0x3) << 6 | (op->ar & 0x1f)); 202 203 /* AMS/D1R */ 204 writeopm(reg + 0x60, (op->ame & 0x1) << 7 | (op->d1r & 0x1f)); 205 206 /* DT2/D2R */ 207 writeopm(reg + 0x80, (op->dt2 & 0x3) << 6 | (op->d2r & 0x1f)); 208 209 /* D1L/RR */ 210 writeopm(reg + 0xa0, (op->d1l & 0xf) << 4 | (op->rr & 0xf)); 211 } 212 213 void 214 opm_set_volume(int channel, int volume) 215 { 216 int value; 217 218 switch (opm0->sc_vdata[channel].con) { 219 case 7: 220 value = opm0->sc_vdata[channel].m1.tl + volume; 221 writeopm(0x60 + channel, ((value > 0x7f) ? 0x7f : value)); 222 case 6: 223 case 5: 224 value = opm0->sc_vdata[channel].m2.tl + volume; 225 writeopm(0x68 + channel, ((value > 0x7f) ? 0x7f : value)); 226 case 4: 227 value = opm0->sc_vdata[channel].c1.tl + volume; 228 writeopm(0x70 + channel, ((value > 0x7f) ? 0x7f : value)); 229 case 3: 230 case 2: 231 case 1: 232 case 0: 233 value = opm0->sc_vdata[channel].c2.tl + volume; 234 writeopm(0x78 + channel, ((value > 0x7f) ? 0x7f : value)); 235 } 236 } 237 238 void 239 opm_set_key(int channel, int tone) 240 { 241 writeopm(0x28 + channel, tone >> 8); 242 writeopm(0x30 + channel, tone & 0xff); 243 } 244 245 /*ARGSUSED*/ 246 int 247 opmopen(dev_t dev, int flag, int mode) 248 { 249 return 0; 250 } 251 252 /*ARGSUSED*/ 253 int 254 opmclose(dev_t dev) 255 { 256 return 0; 257 } 258 259 #endif 260