midisyn.c revision 1.11
1/* $NetBSD: midisyn.c,v 1.11 2003/06/28 14:21:31 darrenr 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@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: midisyn.c,v 1.11 2003/06/28 14:21:31 darrenr Exp $"); 41 42#include <sys/param.h> 43#include <sys/ioctl.h> 44#include <sys/fcntl.h> 45#include <sys/vnode.h> 46#include <sys/select.h> 47#include <sys/proc.h> 48#include <sys/malloc.h> 49#include <sys/systm.h> 50#include <sys/syslog.h> 51#include <sys/kernel.h> 52#include <sys/audioio.h> 53#include <sys/midiio.h> 54#include <sys/device.h> 55 56#include <dev/audio_if.h> 57#include <dev/midi_if.h> 58#include <dev/midivar.h> 59#include <dev/midisynvar.h> 60 61#ifdef AUDIO_DEBUG 62#define DPRINTF(x) if (midisyndebug) printf x 63#define DPRINTFN(n,x) if (midisyndebug >= (n)) printf x 64int midisyndebug = 0; 65#else 66#define DPRINTF(x) 67#define DPRINTFN(n,x) 68#endif 69 70int midisyn_findvoice(midisyn *, int, int); 71void midisyn_freevoice(midisyn *, int); 72int midisyn_allocvoice(midisyn *, u_int32_t, u_int32_t); 73u_int32_t midisyn_note_to_freq(int); 74u_int32_t midisyn_finetune(u_int32_t, int, int, int); 75 76int midisyn_open(void *, int, 77 void (*iintr)(void *, int), 78 void (*ointr)(void *), void *arg); 79void midisyn_close(void *); 80int midisyn_output(void *, int); 81void midisyn_getinfo(void *, struct midi_info *); 82int midisyn_ioctl(void *, u_long, caddr_t, int, struct lwp *); 83 84struct midi_hw_if midisyn_hw_if = { 85 midisyn_open, 86 midisyn_close, 87 midisyn_output, 88 midisyn_getinfo, 89 midisyn_ioctl, 90}; 91 92static const int midi_lengths[] = { 3,3,3,3,2,2,3,1 }; 93/* Number of bytes in a MIDI command, including status */ 94#define MIDI_LENGTH(d) (midi_lengths[((d) >> 4) & 7]) 95 96int 97midisyn_open(void *addr, int flags, void (*iintr)(void *, int), 98 void (*ointr)(void *), void *arg) 99{ 100 midisyn *ms = addr; 101 102 DPRINTF(("midisyn_open: ms=%p ms->mets=%p\n", ms, ms->mets)); 103 if (ms->mets->open) 104 return (ms->mets->open(ms, flags)); 105 else 106 return (0); 107} 108 109void 110midisyn_close(void *addr) 111{ 112 midisyn *ms = addr; 113 struct midisyn_methods *fs; 114 int v; 115 116 DPRINTF(("midisyn_close: ms=%p ms->mets=%p\n", ms, ms->mets)); 117 fs = ms->mets; 118 for (v = 0; v < ms->nvoice; v++) 119 if (ms->voices[v].inuse) { 120 fs->noteoff(ms, v, 0, 0); 121 midisyn_freevoice(ms, v); 122 } 123 if (fs->close) 124 fs->close(ms); 125} 126 127void 128midisyn_getinfo(void *addr, struct midi_info *mi) 129{ 130 midisyn *ms = addr; 131 132 mi->name = ms->name; 133 mi->props = 0; 134} 135 136int 137midisyn_ioctl(void *maddr, u_long cmd, caddr_t addr, int flag, struct lwp *l) 138{ 139 midisyn *ms = maddr; 140 141 if (ms->mets->ioctl) 142 return (ms->mets->ioctl(ms, cmd, addr, flag, l)); 143 else 144 return (EINVAL); 145} 146 147int 148midisyn_findvoice(midisyn *ms, int chan, int note) 149{ 150 u_int cn; 151 int v; 152 153 if (!(ms->flags & MS_DOALLOC)) 154 return (chan); 155 cn = MS_CHANNOTE(chan, note); 156 for (v = 0; v < ms->nvoice; v++) 157 if (ms->voices[v].chan_note == cn && ms->voices[v].inuse) 158 return (v); 159 return (-1); 160} 161 162void 163midisyn_attach(struct midi_softc *sc, midisyn *ms) 164{ 165 if (ms->flags & MS_DOALLOC) { 166 ms->voices = malloc(ms->nvoice * sizeof (struct voice), 167 M_DEVBUF, M_WAITOK|M_ZERO); 168 ms->seqno = 1; 169 if (ms->mets->allocv == 0) 170 ms->mets->allocv = &midisyn_allocvoice; 171 } 172 sc->hw_if = &midisyn_hw_if; 173 sc->hw_hdl = ms; 174 DPRINTF(("midisyn_attach: ms=%p\n", sc->hw_hdl)); 175} 176 177void 178midisyn_freevoice(midisyn *ms, int voice) 179{ 180 if (!(ms->flags & MS_DOALLOC)) 181 return; 182 ms->voices[voice].inuse = 0; 183} 184 185int 186midisyn_allocvoice(midisyn *ms, u_int32_t chan, u_int32_t note) 187{ 188 int bestv, v; 189 u_int bestseq, s; 190 191 if (!(ms->flags & MS_DOALLOC)) 192 return (chan); 193 /* Find a free voice, or if no free voice is found the oldest. */ 194 bestv = 0; 195 bestseq = ms->voices[0].seqno + (ms->voices[0].inuse ? 0x40000000 : 0); 196 for (v = 1; v < ms->nvoice; v++) { 197 s = ms->voices[v].seqno; 198 if (ms->voices[v].inuse) 199 s += 0x40000000; 200 if (s < bestseq) { 201 bestseq = s; 202 bestv = v; 203 } 204 } 205 DPRINTFN(10,("midisyn_allocvoice: v=%d seq=%d cn=%x inuse=%d\n", 206 bestv, ms->voices[bestv].seqno, 207 ms->voices[bestv].chan_note, 208 ms->voices[bestv].inuse)); 209#ifdef AUDIO_DEBUG 210 if (ms->voices[bestv].inuse) 211 DPRINTFN(1,("midisyn_allocvoice: steal %x\n", 212 ms->voices[bestv].chan_note)); 213#endif 214 ms->voices[bestv].chan_note = MS_CHANNOTE(chan, note); 215 ms->voices[bestv].seqno = ms->seqno++; 216 ms->voices[bestv].inuse = 1; 217 return (bestv); 218} 219 220int 221midisyn_output(void *addr, int b) 222{ 223 midisyn *ms = addr; 224 u_int8_t status, chan; 225 int voice = 0; /* initialize to keep gcc quiet */ 226 struct midisyn_methods *fs; 227 u_int32_t note, vel; 228 229 DPRINTF(("midisyn_output: ms=%p b=0x%02x\n", ms, b)); 230 fs = ms->mets; 231 if (ms->pos < 0) { 232 /* Doing SYSEX */ 233 DPRINTF(("midisyn_output: sysex 0x%02x\n", b)); 234 if (fs->sysex) 235 fs->sysex(ms, b); 236 if (b == MIDI_SYSEX_END) 237 ms->pos = 0; 238 return (0); 239 } 240 if (ms->pos == 0 && !MIDI_IS_STATUS(b)) 241 ms->pos++; /* repeat last status byte */ 242 ms->buf[ms->pos++] = b; 243 status = ms->buf[0]; 244 if (ms->pos < MIDI_LENGTH(status)) 245 return (0); 246 /* Decode the MIDI command */ 247 chan = MIDI_GET_CHAN(status); 248 note = ms->buf[1]; 249 if (ms->flags & MS_FREQXLATE) 250 note = midisyn_note_to_freq(note); 251 vel = ms->buf[2]; 252 switch (MIDI_GET_STATUS(status)) { 253 case MIDI_NOTEOFF: 254 voice = midisyn_findvoice(ms, chan, ms->buf[1]); 255 if (voice >= 0) { 256 fs->noteoff(ms, voice, note, vel); 257 midisyn_freevoice(ms, voice); 258 } 259 break; 260 case MIDI_NOTEON: 261 voice = fs->allocv(ms, chan, ms->buf[1]); 262 fs->noteon(ms, voice, note, vel); 263 break; 264 case MIDI_KEY_PRESSURE: 265 if (fs->keypres) { 266 voice = midisyn_findvoice(ms, voice, ms->buf[1]); 267 if (voice >= 0) 268 fs->keypres(ms, voice, note, vel); 269 } 270 break; 271 case MIDI_CTL_CHANGE: 272 if (fs->ctlchg) 273 fs->ctlchg(ms, chan, ms->buf[1], vel); 274 break; 275 case MIDI_PGM_CHANGE: 276 if (fs->pgmchg) 277 fs->pgmchg(ms, chan, ms->buf[1]); 278 break; 279 case MIDI_CHN_PRESSURE: 280 if (fs->chnpres) { 281 voice = midisyn_findvoice(ms, chan, ms->buf[1]); 282 if (voice >= 0) 283 fs->chnpres(ms, voice, note); 284 } 285 break; 286 case MIDI_PITCH_BEND: 287 if (fs->pitchb) { 288 voice = midisyn_findvoice(ms, chan, ms->buf[1]); 289 if (voice >= 0) 290 fs->pitchb(ms, chan, note, vel); 291 } 292 break; 293 case MIDI_SYSTEM_PREFIX: 294 if (fs->sysex) 295 fs->sysex(ms, status); 296 ms->pos = -1; 297 return (0); 298 } 299 ms->pos = 0; 300 return (0); 301} 302 303/* 304 * Convert a MIDI note to the corresponding frequency. 305 * The frequency is scaled by 2^16. 306 */ 307u_int32_t 308midisyn_note_to_freq(int note) 309{ 310 int o, n, f; 311#define BASE_OCTAVE 5 312 static const u_int32_t notes[] = { 313 17145893, 18165441, 19245614, 20390018, 21602472, 22887021, 314 24247954, 25689813, 27217409, 28835840, 30550508, 32367136 315 }; 316 317 318 o = note / 12; 319 n = note % 12; 320 321 f = notes[n]; 322 323 if (o < BASE_OCTAVE) 324 f >>= (BASE_OCTAVE - o); 325 else if (o > BASE_OCTAVE) 326 f <<= (o - BASE_OCTAVE); 327 return (f); 328} 329 330u_int32_t 331midisyn_finetune(u_int32_t base_freq, int bend, int range, int vibrato_cents) 332{ 333 static const u_int16_t semitone_tuning[24] = 334 { 335/* 0 */ 10000, 10595, 11225, 11892, 12599, 13348, 14142, 14983, 336/* 8 */ 15874, 16818, 17818, 18877, 20000, 21189, 22449, 23784, 337/* 16 */ 25198, 26697, 28284, 29966, 31748, 33636, 35636, 37755 338 }; 339 static const u_int16_t cent_tuning[100] = 340 { 341/* 0 */ 10000, 10006, 10012, 10017, 10023, 10029, 10035, 10041, 342/* 8 */ 10046, 10052, 10058, 10064, 10070, 10075, 10081, 10087, 343/* 16 */ 10093, 10099, 10105, 10110, 10116, 10122, 10128, 10134, 344/* 24 */ 10140, 10145, 10151, 10157, 10163, 10169, 10175, 10181, 345/* 32 */ 10187, 10192, 10198, 10204, 10210, 10216, 10222, 10228, 346/* 40 */ 10234, 10240, 10246, 10251, 10257, 10263, 10269, 10275, 347/* 48 */ 10281, 10287, 10293, 10299, 10305, 10311, 10317, 10323, 348/* 56 */ 10329, 10335, 10341, 10347, 10353, 10359, 10365, 10371, 349/* 64 */ 10377, 10383, 10389, 10395, 10401, 10407, 10413, 10419, 350/* 72 */ 10425, 10431, 10437, 10443, 10449, 10455, 10461, 10467, 351/* 80 */ 10473, 10479, 10485, 10491, 10497, 10503, 10509, 10515, 352/* 88 */ 10521, 10528, 10534, 10540, 10546, 10552, 10558, 10564, 353/* 96 */ 10570, 10576, 10582, 10589 354 }; 355 u_int32_t amount; 356 int negative, semitones, cents, multiplier; 357 358 if (range == 0) 359 return base_freq; 360 361 if (base_freq == 0) 362 return base_freq; 363 364 if (range >= 8192) 365 range = 8192; 366 367 bend = bend * range / 8192; 368 bend += vibrato_cents; 369 370 if (bend == 0) 371 return base_freq; 372 373 if (bend < 0) { 374 bend = -bend; 375 negative = 1; 376 } else 377 negative = 0; 378 379 if (bend > range) 380 bend = range; 381 382 multiplier = 1; 383 while (bend > 2399) { 384 multiplier *= 4; 385 bend -= 2400; 386 } 387 388 semitones = bend / 100; 389 if (semitones > 99) 390 semitones = 99; 391 cents = bend % 100; 392 393 amount = semitone_tuning[semitones] * multiplier * cent_tuning[cents] 394 / 10000; 395 396 if (negative) 397 return (base_freq * 10000 / amount); /* Bend down */ 398 else 399 return (base_freq * amount / 10000); /* Bend up */ 400} 401 402