mpu.c revision 1.14.6.1
1 /* $NetBSD: mpu.c,v 1.14.6.1 2007/02/27 14:16:03 ad Exp $ */ 2 3 /* 4 * Copyright (c) 1998 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Lennart Augustsson (augustss (at) NetBSD.org). 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 3. All advertising materials mentioning features or use of this software 19 * must display the following acknowledgement: 20 * This product includes software developed by the NetBSD 21 * Foundation, Inc. and its contributors. 22 * 4. Neither the name of The NetBSD Foundation nor the names of its 23 * contributors may be used to endorse or promote products derived 24 * from this software without specific prior written permission. 25 * 26 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 27 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 28 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 29 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 30 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 33 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 34 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 36 * POSSIBILITY OF SUCH DAMAGE. 37 */ 38 39 #include <sys/cdefs.h> 40 __KERNEL_RCSID(0, "$NetBSD: mpu.c,v 1.14.6.1 2007/02/27 14:16:03 ad Exp $"); 41 42 #include <sys/param.h> 43 #include <sys/systm.h> 44 #include <sys/errno.h> 45 #include <sys/ioctl.h> 46 #include <sys/syslog.h> 47 #include <sys/device.h> 48 #include <sys/proc.h> 49 #include <sys/buf.h> 50 51 #include <machine/cpu.h> 52 #include <machine/intr.h> 53 #include <machine/bus.h> 54 55 #include <dev/midi_if.h> 56 57 #include <dev/ic/mpuvar.h> 58 59 #ifdef AUDIO_DEBUG 60 #define DPRINTF(x) if (mpudebug) printf x 61 #define DPRINTFN(n,x) if (mpudebug >= (n)) printf x 62 int mpudebug = 0; 63 #else 64 #define DPRINTF(x) 65 #define DPRINTFN(n,x) 66 #endif 67 68 #define MPU_DATA 0 69 #define MPU_COMMAND 1 70 #define MPU_RESET 0xff 71 #define MPU_UART_MODE 0x3f 72 #define MPU_ACK 0xfe 73 #define MPU_STATUS 1 74 #define MPU_OUTPUT_BUSY 0x40 75 #define MPU_INPUT_EMPTY 0x80 76 77 #define MPU_MAXWAIT 10000 /* usec/10 to wait */ 78 79 #define MPU_GETSTATUS(iot, ioh) (bus_space_read_1(iot, ioh, MPU_STATUS)) 80 81 int mpu_reset(struct mpu_softc *); 82 static inline int mpu_waitready(struct mpu_softc *); 83 void mpu_readinput(struct mpu_softc *); 84 85 int mpu_open(void *, int, 86 void (*iintr)(void *, int), 87 void (*ointr)(void *), void *arg); 88 void mpu_close(void *); 89 int mpu_output(void *, int); 90 void mpu_getinfo(void *, struct midi_info *); 91 92 const struct midi_hw_if mpu_midi_hw_if = { 93 mpu_open, 94 mpu_close, 95 mpu_output, 96 mpu_getinfo, 97 0, /* ioctl */ 98 NULL, /* XXXAD */ 99 }; 100 101 int 102 mpu_find(sc) 103 struct mpu_softc *sc; 104 { 105 if (MPU_GETSTATUS(sc->iot, sc->ioh) == 0xff) { 106 DPRINTF(("mpu_find: No status\n")); 107 goto bad; 108 } 109 sc->open = 0; 110 sc->intr = 0; 111 if (mpu_reset(sc) == 0) 112 return 1; 113 bad: 114 return 0; 115 } 116 117 void 118 mpu_attach(sc) 119 struct mpu_softc *sc; 120 { 121 midi_attach_mi(&mpu_midi_hw_if, sc, &sc->sc_dev); 122 } 123 124 static inline int 125 mpu_waitready(sc) 126 struct mpu_softc *sc; 127 { 128 int i; 129 130 for(i = 0; i < MPU_MAXWAIT; i++) { 131 if (!(MPU_GETSTATUS(sc->iot, sc->ioh) & MPU_OUTPUT_BUSY)) 132 return 0; 133 delay(10); 134 } 135 return 1; 136 } 137 138 int 139 mpu_reset(sc) 140 struct mpu_softc *sc; 141 { 142 bus_space_tag_t iot = sc->iot; 143 bus_space_handle_t ioh = sc->ioh; 144 int i; 145 int s; 146 147 if (mpu_waitready(sc)) { 148 DPRINTF(("mpu_reset: not ready\n")); 149 return EIO; 150 } 151 s = splaudio(); /* Don't let the interrupt get our ACK. */ 152 bus_space_write_1(iot, ioh, MPU_COMMAND, MPU_RESET); 153 for(i = 0; i < 2*MPU_MAXWAIT; i++) { 154 if (!(MPU_GETSTATUS(iot, ioh) & MPU_INPUT_EMPTY) && 155 bus_space_read_1(iot, ioh, MPU_DATA) == MPU_ACK) { 156 splx(s); 157 return 0; 158 } 159 } 160 splx(s); 161 DPRINTF(("mpu_reset: No ACK\n")); 162 return EIO; 163 } 164 165 int 166 mpu_open(void *addr, int flags, void (*iintr)(void *, int), 167 void (*ointr)(void *), void *arg) 168 { 169 struct mpu_softc *sc = addr; 170 171 DPRINTF(("mpu_open: sc=%p\n", sc)); 172 173 if (sc->open) 174 return EBUSY; 175 #ifndef AUDIO_NO_POWER_CTL 176 if (sc->powerctl) 177 sc->powerctl(sc->powerarg, 1); 178 #endif 179 if (mpu_reset(sc) != 0) { 180 #ifndef AUDIO_NO_POWER_CTL 181 if (sc->powerctl) 182 sc->powerctl(sc->powerarg, 0); 183 #endif 184 return EIO; 185 } 186 187 bus_space_write_1(sc->iot, sc->ioh, MPU_COMMAND, MPU_UART_MODE); 188 sc->open = 1; 189 sc->intr = iintr; 190 sc->arg = arg; 191 return 0; 192 } 193 194 void 195 mpu_close(addr) 196 void *addr; 197 { 198 struct mpu_softc *sc = addr; 199 200 DPRINTF(("mpu_close: sc=%p\n", sc)); 201 202 sc->open = 0; 203 sc->intr = 0; 204 mpu_reset(sc); /* exit UART mode */ 205 206 #ifndef AUDIO_NO_POWER_CTL 207 if (sc->powerctl) 208 sc->powerctl(sc->powerarg, 0); 209 #endif 210 } 211 212 void 213 mpu_readinput(sc) 214 struct mpu_softc *sc; 215 { 216 bus_space_tag_t iot = sc->iot; 217 bus_space_handle_t ioh = sc->ioh; 218 int data; 219 220 while(!(MPU_GETSTATUS(iot, ioh) & MPU_INPUT_EMPTY)) { 221 data = bus_space_read_1(iot, ioh, MPU_DATA); 222 DPRINTFN(3, ("mpu_rea: sc=%p 0x%02x\n", sc, data)); 223 if (sc->intr) 224 sc->intr(sc->arg, data); 225 } 226 } 227 228 int 229 mpu_output(addr, d) 230 void *addr; 231 int d; 232 { 233 struct mpu_softc *sc = addr; 234 int s; 235 236 DPRINTFN(3, ("mpu_output: sc=%p 0x%02x\n", sc, d)); 237 if (!(MPU_GETSTATUS(sc->iot, sc->ioh) & MPU_INPUT_EMPTY)) { 238 s = splaudio(); 239 mpu_readinput(sc); 240 splx(s); 241 } 242 if (mpu_waitready(sc)) { 243 DPRINTF(("mpu_output: not ready\n")); 244 return EIO; 245 } 246 bus_space_write_1(sc->iot, sc->ioh, MPU_DATA, d); 247 return 0; 248 } 249 250 void 251 mpu_getinfo(addr, mi) 252 void *addr; 253 struct midi_info *mi; 254 { 255 struct mpu_softc *sc = addr; 256 257 mi->name = sc->model; 258 mi->props = 0; 259 } 260 261 int 262 mpu_intr(addr) 263 void *addr; 264 { 265 struct mpu_softc *sc = addr; 266 267 if (MPU_GETSTATUS(sc->iot, sc->ioh) & MPU_INPUT_EMPTY) { 268 DPRINTF(("mpu_intr: no data\n")); 269 return (0); 270 } else { 271 mpu_readinput(sc); 272 return (1); 273 } 274 } 275
Indexes created Tue Oct 07 11:09:55 GMT 2025