sys/arch/x68k/dev/opm.c

   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
  53 struct 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
  60 struct opm_softc        *opm0;  /* XXX */
  61
  62 static int opm_match(device_t, cfdata_t, void *);
  63 static void opm_attach(device_t, device_t, void *);
  64
  65 CFATTACH_DECL_NEW(opm, sizeof(struct opm_softc),
  66     opm_match, opm_attach, NULL, NULL);
  67
  68 static int
  69 opm_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
  85 static void
  86 opm_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
 117 void opm_set_volume(int, int);
 118 void opm_set_key(int, int);
 119 void opm_set_voice(int, struct opm_voice *);
 120 void opm_set_voice_sub(int, struct opm_operator *);
 121 inline static void writeopm(int, int);
 122 inline static int readopm(int);
 123 void opm_key_on(u_char);
 124 void opm_key_off(u_char);
 125 int opmopen(dev_t, int, int);
 126 int opmclose(dev_t);
 127
 128 inline static void
 129 writeopm(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
 138 inline static int
 139 readopm(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
 149 void
 150 adpcm_chgclk(u_char clk)
 151 {
 152         writeopm(0x1b, (readopm(0x1b) & ~OPM1B_CT1MSK) | clk);
 153 }
 154 #endif
 155
 156 #if NFD > 0
 157 void
 158 fdc_force_ready(u_char rdy)
 159 {
 160         writeopm(0x1b, (readopm(0x1b) & ~OPM1B_CT2MSK) | rdy);
 161 }
 162 #endif
 163
 164 #if NBELL > 0
 165 void
 166 opm_key_on(u_char channel)
 167 {
 168         writeopm(0x08, opm0->sc_vdata[channel].sm << 3 | channel);
 169 }
 170
 171 void
 172 opm_key_off(u_char channel)
 173 {
 174         writeopm(0x08, channel);
 175 }
 176
 177 void
 178 opm_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
 190 void
 191 opm_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
 212 void
 213 opm_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
 237 void
 238 opm_set_key(int channel, int tone)
 239 {
 240         writeopm(0x28 + channel, tone >> 8);
 241         writeopm(0x30 + channel, tone & 0xff);
 242 }
 243
 244 /*ARGSUSED*/
 245 int
 246 opmopen(dev_t dev, int flag, int mode)
 247 {
 248         return 0;
 249 }
 250
 251 /*ARGSUSED*/
 252 int
 253 opmclose(dev_t dev)
 254 {
 255         return 0;
 256 }
 257
 258 #endif