/* $NetBSD: mpu.c,v 1.19 2012/01/21 16:49:26 chs Exp $ */ /* * Copyright (c) 1998, 2008 The NetBSD Foundation, Inc. * All rights reserved. * * This code is derived from software contributed to The NetBSD Foundation * by Lennart Augustsson (augustss@NetBSD.org) and by Andrew Doran. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include __KERNEL_RCSID(0, "$NetBSD: mpu.c,v 1.19 2012/01/21 16:49:26 chs Exp $"); #include #include #include #include #include #include #include #include #include #include #include #include #include #ifdef AUDIO_DEBUG #define DPRINTF(x) if (mpudebug) printf x #define DPRINTFN(n,x) if (mpudebug >= (n)) printf x int mpudebug = 0; #else #define DPRINTF(x) #define DPRINTFN(n,x) #endif #define MPU_DATA 0 #define MPU_COMMAND 1 #define MPU_RESET 0xff #define MPU_UART_MODE 0x3f #define MPU_ACK 0xfe #define MPU_STATUS 1 #define MPU_OUTPUT_BUSY 0x40 #define MPU_INPUT_EMPTY 0x80 #define MPU_MAXWAIT 10000 /* usec/10 to wait */ #define MPU_GETSTATUS(iot, ioh) (bus_space_read_1(iot, ioh, MPU_STATUS)) static int mpu_reset(struct mpu_softc *); static inline int mpu_waitready(struct mpu_softc *); static void mpu_readinput(struct mpu_softc *); static int mpu_open(void *, int, void (*iintr)(void *, int), void (*ointr)(void *), void *arg); static void mpu_close(void *); static int mpu_output(void *, int); static void mpu_getinfo(void *, struct midi_info *); static void mpu_get_locks(void *, kmutex_t **, kmutex_t **); const struct midi_hw_if mpu_midi_hw_if = { mpu_open, mpu_close, mpu_output, mpu_getinfo, 0, /* ioctl */ mpu_get_locks, }; int mpu_find(struct mpu_softc *sc) { if (MPU_GETSTATUS(sc->iot, sc->ioh) == 0xff) { DPRINTF(("%s: No status\n", __func__)); goto bad; } sc->open = 0; sc->intr = 0; if (mpu_reset(sc) == 0) return 1; bad: return 0; } void mpu_attach(struct mpu_softc *sc) { if (sc->lock == NULL) { panic("mpu_attach: no lock"); } midi_attach_mi(&mpu_midi_hw_if, sc, sc->sc_dev); } static inline int mpu_waitready(struct mpu_softc *sc) { int i; KASSERT(sc->lock == NULL || mutex_owned(sc->lock)); for (i = 0; i < MPU_MAXWAIT; i++) { if (!(MPU_GETSTATUS(sc->iot, sc->ioh) & MPU_OUTPUT_BUSY)) return 0; delay(10); } return 1; } static int mpu_reset(struct mpu_softc *sc) { bus_space_tag_t iot = sc->iot; bus_space_handle_t ioh = sc->ioh; int i; KASSERT(sc->lock == NULL || mutex_owned(sc->lock)); if (mpu_waitready(sc)) { DPRINTF(("%s: not ready\n", __func__)); return EIO; } bus_space_write_1(iot, ioh, MPU_COMMAND, MPU_RESET); for (i = 0; i < 2*MPU_MAXWAIT; i++) { if (!(MPU_GETSTATUS(iot, ioh) & MPU_INPUT_EMPTY) && bus_space_read_1(iot, ioh, MPU_DATA) == MPU_ACK) { return 0; } } DPRINTF(("%s: No ACK\n", __func__)); return EIO; } static int mpu_open(void *addr, int flags, void (*iintr)(void *, int), void (*ointr)(void *), void *arg) { struct mpu_softc *sc = addr; DPRINTF(("%s: sc=%p\n", __func__, sc)); KASSERT(mutex_owned(sc->lock)); if (sc->open) return EBUSY; #ifndef AUDIO_NO_POWER_CTL if (sc->powerctl) sc->powerctl(sc->powerarg, 1); #endif if (mpu_reset(sc) != 0) { #ifndef AUDIO_NO_POWER_CTL if (sc->powerctl) sc->powerctl(sc->powerarg, 0); #endif return EIO; } bus_space_write_1(sc->iot, sc->ioh, MPU_COMMAND, MPU_UART_MODE); sc->open = 1; sc->intr = iintr; sc->arg = arg; return 0; } static void mpu_close(void *addr) { struct mpu_softc *sc = addr; DPRINTF(("%s: sc=%p\n", __func__, sc)); KASSERT(mutex_owned(sc->lock)); sc->open = 0; sc->intr = 0; mpu_reset(sc); /* exit UART mode */ #ifndef AUDIO_NO_POWER_CTL if (sc->powerctl) sc->powerctl(sc->powerarg, 0); #endif } static void mpu_readinput(struct mpu_softc *sc) { bus_space_tag_t iot = sc->iot; bus_space_handle_t ioh = sc->ioh; int data; KASSERT(mutex_owned(sc->lock)); while(!(MPU_GETSTATUS(iot, ioh) & MPU_INPUT_EMPTY)) { data = bus_space_read_1(iot, ioh, MPU_DATA); DPRINTFN(3, ("%s: sc=%p 0x%02x\n", __func__, sc, data)); if (sc->intr) sc->intr(sc->arg, data); } } static int mpu_output(void *addr, int d) { struct mpu_softc *sc = addr; KASSERT(mutex_owned(sc->lock)); DPRINTFN(3, ("%s: sc=%p 0x%02x\n", __func__, sc, d)); if (!(MPU_GETSTATUS(sc->iot, sc->ioh) & MPU_INPUT_EMPTY)) { mpu_readinput(sc); } if (mpu_waitready(sc)) { DPRINTF(("%s:: not ready\n", __func__)); return EIO; } bus_space_write_1(sc->iot, sc->ioh, MPU_DATA, d); return 0; } static void mpu_getinfo(void *addr, struct midi_info *mi) { struct mpu_softc *sc = addr; KASSERT(mutex_owned(sc->lock)); mi->name = sc->model; mi->props = 0; } static void mpu_get_locks(void *addr, kmutex_t **intr, kmutex_t **proc) { struct mpu_softc *sc = addr; *intr = sc->lock; *proc = NULL; } int mpu_intr(void *addr) { struct mpu_softc *sc = addr; KASSERT(mutex_owned(sc->lock)); if (MPU_GETSTATUS(sc->iot, sc->ioh) & MPU_INPUT_EMPTY) { DPRINTF(("%s: no data\n", __func__)); return 0; } else { mpu_readinput(sc); return 1; } }