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