sys/dev/sound/midi/mpu401.c

   1 /*-
   2  * Copyright (c) 2003 Mathew Kanner
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24  * SUCH DAMAGE.
  25  */
  26
  27 #include <sys/cdefs.h>
  28 __FBSDID("$FreeBSD$");
  29
  30 #include <sys/param.h>
  31 #include <sys/types.h>
  32 #include <sys/param.h>
  33 #include <sys/queue.h>
  34 #include <sys/kernel.h>
  35 #include <sys/lock.h>
  36 #include <sys/mutex.h>
  37 #include <sys/proc.h>
  38 #include <sys/systm.h>
  39 #include <sys/kobj.h>
  40 #include <sys/malloc.h>
  41 #include <sys/bus.h>                    /* to get driver_intr_t */
  42
  43 #ifdef HAVE_KERNEL_OPTION_HEADERS
  44 #include "opt_snd.h"
  45 #endif
  46
  47 #include <dev/sound/midi/mpu401.h>
  48 #include <dev/sound/midi/midi.h>
  49
  50 #include "mpu_if.h"
  51 #include "mpufoi_if.h"
  52
  53 #ifndef KOBJMETHOD_END
  54 #define KOBJMETHOD_END  { NULL, NULL }
  55 #endif
  56
  57 #define MPU_DATAPORT   0
  58 #define MPU_CMDPORT    1
  59 #define MPU_STATPORT   1
  60 #define MPU_RESET      0xff
  61 #define MPU_UART       0x3f
  62 #define MPU_ACK        0xfe
  63 #define MPU_STATMASK   0xc0
  64 #define MPU_OUTPUTBUSY 0x40
  65 #define MPU_INPUTBUSY  0x80
  66 #define MPU_TRYDATA 50
  67 #define MPU_DELAY   2500
  68
  69 #define CMD(m,d)        MPUFOI_WRITE(m, m->cookie, MPU_CMDPORT,d)
  70 #define STATUS(m)       MPUFOI_READ(m, m->cookie, MPU_STATPORT)
  71 #define READ(m)         MPUFOI_READ(m, m->cookie, MPU_DATAPORT)
  72 #define WRITE(m,d)      MPUFOI_WRITE(m, m->cookie, MPU_DATAPORT,d)
  73
  74 struct mpu401 {
  75         KOBJ_FIELDS;
  76         struct snd_midi *mid;
  77         int     flags;
  78         driver_intr_t *si;
  79         void   *cookie;
  80         struct callout timer;
  81 };
  82
  83 static void mpu401_timeout(void *m);
  84 static mpu401_intr_t mpu401_intr;
  85
  86 static int mpu401_minit(struct snd_midi *, void *);
  87 static int mpu401_muninit(struct snd_midi *, void *);
  88 static int mpu401_minqsize(struct snd_midi *, void *);
  89 static int mpu401_moutqsize(struct snd_midi *, void *);
  90 static void mpu401_mcallback(struct snd_midi *, void *, int);
  91 static void mpu401_mcallbackp(struct snd_midi *, void *, int);
  92 static const char *mpu401_mdescr(struct snd_midi *, void *, int);
  93 static const char *mpu401_mprovider(struct snd_midi *, void *);
  94
  95 static kobj_method_t mpu401_methods[] = {
  96         KOBJMETHOD(mpu_init, mpu401_minit),
  97         KOBJMETHOD(mpu_uninit, mpu401_muninit),
  98         KOBJMETHOD(mpu_inqsize, mpu401_minqsize),
  99         KOBJMETHOD(mpu_outqsize, mpu401_moutqsize),
 100         KOBJMETHOD(mpu_callback, mpu401_mcallback),
 101         KOBJMETHOD(mpu_callbackp, mpu401_mcallbackp),
 102         KOBJMETHOD(mpu_descr, mpu401_mdescr),
 103         KOBJMETHOD(mpu_provider, mpu401_mprovider),
 104         KOBJMETHOD_END
 105 };
 106
 107 DEFINE_CLASS(mpu401, mpu401_methods, 0);
 108
 109 void
 110 mpu401_timeout(void *a)
 111 {
 112         struct mpu401 *m = (struct mpu401 *)a;
 113
 114         if (m->si)
 115                 (m->si)(m->cookie);
 116
 117 }
 118 static int
 119 mpu401_intr(struct mpu401 *m)
 120 {
 121 #define MPU_INTR_BUF    16
 122         MIDI_TYPE b[MPU_INTR_BUF];
 123         int i;
 124         int s;
 125
 126 /*
 127         printf("mpu401_intr\n");
 128 */
 129 #define RXRDY(m) ( (STATUS(m) & MPU_INPUTBUSY) == 0)
 130 #define TXRDY(m) ( (STATUS(m) & MPU_OUTPUTBUSY) == 0)
 131 #if 0
 132 #define D(x,l) printf("mpu401_intr %d %x %s %s\n",l, x, x&MPU_INPUTBUSY?"RX":"", x&MPU_OUTPUTBUSY?"TX":"")
 133 #else
 134 #define D(x,l)
 135 #endif
 136         i = 0;
 137         s = STATUS(m);
 138         D(s, 1);
 139         while ((s & MPU_INPUTBUSY) == 0 && i < MPU_INTR_BUF) {
 140                 b[i] = READ(m);
 141 /*
 142                 printf("mpu401_intr in i %d d %d\n", i, b[i]);
 143 */
 144                 i++;
 145                 s = STATUS(m);
 146         }
 147         if (i)
 148                 midi_in(m->mid, b, i);
 149         i = 0;
 150         while (!(s & MPU_OUTPUTBUSY) && i < MPU_INTR_BUF) {
 151                 if (midi_out(m->mid, b, 1)) {
 152 /*
 153                         printf("mpu401_intr out i %d d %d\n", i, b[0]);
 154 */
 155
 156                         WRITE(m, *b);
 157                 } else {
 158 /*
 159                         printf("mpu401_intr write: no output\n");
 160 */
 161                         return 0;
 162                 }
 163                 i++;
 164                 /* DELAY(100); */
 165                 s = STATUS(m);
 166         }
 167
 168         if ((m->flags & M_TXEN) && (m->si)) {
 169                 callout_reset(&m->timer, 1, mpu401_timeout, m);
 170         }
 171         return (m->flags & M_TXEN) == M_TXEN;
 172 }
 173
 174 struct mpu401 *
 175 mpu401_init(kobj_class_t cls, void *cookie, driver_intr_t softintr,
 176     mpu401_intr_t ** cb)
 177 {
 178         struct mpu401 *m;
 179
 180         *cb = NULL;
 181         m = malloc(sizeof(*m), M_MIDI, M_NOWAIT | M_ZERO);
 182
 183         if (!m)
 184                 return NULL;
 185
 186         kobj_init((kobj_t)m, cls);
 187
 188         callout_init(&m->timer, CALLOUT_MPSAFE);
 189
 190         m->si = softintr;
 191         m->cookie = cookie;
 192         m->flags = 0;
 193
 194         m->mid = midi_init(&mpu401_class, 0, 0, m);
 195         if (!m->mid)
 196                 goto err;
 197         *cb = mpu401_intr;
 198         return m;
 199 err:
 200         printf("mpu401_init error\n");
 201         free(m, M_MIDI);
 202         return NULL;
 203 }
 204
 205 int
 206 mpu401_uninit(struct mpu401 *m)
 207 {
 208         int retval;
 209
 210         CMD(m, MPU_RESET);
 211         retval = midi_uninit(m->mid);
 212         if (retval)
 213                 return retval;
 214         free(m, M_MIDI);
 215         return 0;
 216 }
 217
 218 static int
 219 mpu401_minit(struct snd_midi *sm, void *arg)
 220 {
 221         struct mpu401 *m = arg;
 222         int i;
 223
 224         CMD(m, MPU_RESET);
 225         CMD(m, MPU_UART);
 226         return 0;
 227         i = 0;
 228         while (++i < 2000) {
 229                 if (RXRDY(m))
 230                         if (READ(m) == MPU_ACK)
 231                                 break;
 232         }
 233
 234         if (i < 2000) {
 235                 CMD(m, MPU_UART);
 236                 return 0;
 237         }
 238         printf("mpu401_minit failed active sensing\n");
 239         return 1;
 240 }
 241
 242
 243 int
 244 mpu401_muninit(struct snd_midi *sm, void *arg)
 245 {
 246         struct mpu401 *m = arg;
 247
 248         return MPUFOI_UNINIT(m, m->cookie);
 249 }
 250
 251 int
 252 mpu401_minqsize(struct snd_midi *sm, void *arg)
 253 {
 254         return 128;
 255 }
 256
 257 int
 258 mpu401_moutqsize(struct snd_midi *sm, void *arg)
 259 {
 260         return 128;
 261 }
 262
 263 static void
 264 mpu401_mcallback(struct snd_midi *sm, void *arg, int flags)
 265 {
 266         struct mpu401 *m = arg;
 267 #if 0
 268         printf("mpu401_callback %s %s %s %s\n",
 269             flags & M_RX ? "M_RX" : "",
 270             flags & M_TX ? "M_TX" : "",
 271             flags & M_RXEN ? "M_RXEN" : "",
 272             flags & M_TXEN ? "M_TXEN" : "");
 273 #endif
 274         if (flags & M_TXEN && m->si) {
 275                 callout_reset(&m->timer, 1, mpu401_timeout, m);
 276         }
 277         m->flags = flags;
 278 }
 279
 280 static void
 281 mpu401_mcallbackp(struct snd_midi *sm, void *arg, int flags)
 282 {
 283 /*      printf("mpu401_callbackp\n"); */
 284         mpu401_mcallback(sm, arg, flags);
 285 }
 286
 287 static const char *
 288 mpu401_mdescr(struct snd_midi *sm, void *arg, int verbosity)
 289 {
 290
 291         return "descr mpu401";
 292 }
 293
 294 static const char *
 295 mpu401_mprovider(struct snd_midi *m, void *arg)
 296 {
 297         return "provider mpu401";
 298 }