Home | History | Annotate | Line # | Download | only in dev
opm.c revision 1.10.6.4
      1 /*	$NetBSD: opm.c,v 1.10.6.4 2005/01/24 08:35:10 skrll 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.10.6.4 2005/01/24 08:35:10 skrll 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