Home | History | Annotate | Line # | Download | only in dev
midisyn.c revision 1.24
      1  1.24    plunky /*	$NetBSD: midisyn.c,v 1.24 2012/04/09 10:18:16 plunky Exp $	*/
      2   1.1  augustss 
      3   1.1  augustss /*
      4  1.23  jmcneill  * Copyright (c) 1998, 2008 The NetBSD Foundation, Inc.
      5   1.1  augustss  * All rights reserved.
      6   1.1  augustss  *
      7   1.5  augustss  * This code is derived from software contributed to The NetBSD Foundation
      8  1.23  jmcneill  * by Lennart Augustsson (augustss (at) NetBSD.org), and by Andrew Doran.
      9   1.1  augustss  *
     10   1.1  augustss  * Redistribution and use in source and binary forms, with or without
     11   1.1  augustss  * modification, are permitted provided that the following conditions
     12   1.1  augustss  * are met:
     13   1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     14   1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     15   1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     17   1.1  augustss  *    documentation and/or other materials provided with the distribution.
     18   1.1  augustss  *
     19   1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     30   1.1  augustss  */
     31   1.9     lukem 
     32   1.9     lukem #include <sys/cdefs.h>
     33  1.24    plunky __KERNEL_RCSID(0, "$NetBSD: midisyn.c,v 1.24 2012/04/09 10:18:16 plunky Exp $");
     34   1.1  augustss 
     35   1.1  augustss #include <sys/param.h>
     36   1.1  augustss #include <sys/ioctl.h>
     37   1.1  augustss #include <sys/fcntl.h>
     38   1.1  augustss #include <sys/vnode.h>
     39   1.1  augustss #include <sys/select.h>
     40   1.1  augustss #include <sys/proc.h>
     41  1.23  jmcneill #include <sys/kmem.h>
     42   1.1  augustss #include <sys/systm.h>
     43   1.1  augustss #include <sys/syslog.h>
     44   1.1  augustss #include <sys/kernel.h>
     45   1.1  augustss #include <sys/audioio.h>
     46   1.1  augustss #include <sys/midiio.h>
     47   1.1  augustss #include <sys/device.h>
     48   1.1  augustss 
     49   1.1  augustss #include <dev/audio_if.h>
     50   1.3  augustss #include <dev/midi_if.h>
     51   1.1  augustss #include <dev/midivar.h>
     52   1.1  augustss #include <dev/midisynvar.h>
     53   1.1  augustss 
     54   1.1  augustss #ifdef AUDIO_DEBUG
     55   1.1  augustss #define DPRINTF(x)	if (midisyndebug) printf x
     56   1.1  augustss #define DPRINTFN(n,x)	if (midisyndebug >= (n)) printf x
     57   1.1  augustss int	midisyndebug = 0;
     58   1.1  augustss #else
     59   1.1  augustss #define DPRINTF(x)
     60   1.1  augustss #define DPRINTFN(n,x)
     61   1.1  augustss #endif
     62   1.1  augustss 
     63  1.23  jmcneill static int	midisyn_findvoice(midisyn *, int, int);
     64  1.23  jmcneill static void	midisyn_freevoice(midisyn *, int);
     65  1.23  jmcneill static uint_fast16_t	midisyn_allocvoice(midisyn *, uint_fast8_t, uint_fast8_t);
     66  1.18      chap static void	midisyn_attackv_vel(midisyn *, uint_fast16_t, midipitch_t,
     67  1.18      chap                                     int16_t, uint_fast8_t);
     68  1.18      chap 
     69  1.18      chap static midictl_notify midisyn_notify;
     70  1.18      chap 
     71  1.18      chap static midipitch_t midisyn_clamp_pitch(midipitch_t);
     72  1.18      chap static int16_t midisyn_adj_level(midisyn *, uint_fast8_t);
     73  1.18      chap static midipitch_t midisyn_adj_pitch(midisyn *, uint_fast8_t);
     74  1.18      chap static void midisyn_chan_releasev(midisyn *, uint_fast8_t, uint_fast8_t);
     75  1.18      chap static void midisyn_upd_level(midisyn *, uint_fast8_t);
     76  1.18      chap static void midisyn_upd_pitch(midisyn *, uint_fast8_t);
     77   1.8  augustss 
     78  1.23  jmcneill static int	midisyn_open(void *, int,
     79  1.23  jmcneill 			     void (*iintr)(void *, int),
     80  1.23  jmcneill 			     void (*ointr)(void *), void *arg);
     81  1.23  jmcneill static void	midisyn_close(void *);
     82  1.23  jmcneill static int	midisyn_sysrt(void *, int);
     83  1.23  jmcneill static void	midisyn_getinfo(void *, struct midi_info *);
     84  1.23  jmcneill static int	midisyn_ioctl(void *, u_long, void *, int, struct lwp *);
     85  1.23  jmcneill static void	midisyn_get_locks(void *, kmutex_t **, kmutex_t **);
     86   1.1  augustss 
     87  1.14      yamt const struct midi_hw_if midisyn_hw_if = {
     88   1.1  augustss 	midisyn_open,
     89   1.1  augustss 	midisyn_close,
     90  1.18      chap 	midisyn_sysrt,
     91   1.1  augustss 	midisyn_getinfo,
     92   1.1  augustss 	midisyn_ioctl,
     93  1.23  jmcneill 	midisyn_get_locks,
     94   1.1  augustss };
     95   1.1  augustss 
     96  1.23  jmcneill static int	midisyn_channelmsg(void *, int, int, u_char *, int);
     97  1.23  jmcneill static int	midisyn_commonmsg(void *, int, u_char *, int);
     98  1.23  jmcneill static int	midisyn_sysex(void *, u_char *, int);
     99  1.18      chap 
    100  1.18      chap struct midi_hw_if_ext midisyn_hw_if_ext = {
    101  1.18      chap 	.channel = midisyn_channelmsg,
    102  1.18      chap 	.common  = midisyn_commonmsg,
    103  1.18      chap 	.sysex   = midisyn_sysex,
    104  1.18      chap };
    105  1.18      chap 
    106  1.18      chap struct channelstate { /* dyamically allocated in open() on account of size */
    107  1.18      chap 	/* volume state components in centibels; just sum for overall level */
    108  1.18      chap 	int16_t volume;
    109  1.18      chap 	int16_t expression;
    110  1.18      chap 	/* pitch state components in midipitch units; sum for overall effect */
    111  1.18      chap 	midipitch_t bend;
    112  1.18      chap 	midipitch_t tuning_fine;
    113  1.18      chap 	midipitch_t tuning_coarse;
    114  1.18      chap 	/* used by bend handlers */
    115  1.18      chap 	int16_t bendraw;
    116  1.18      chap 	int16_t pendingreset;
    117  1.18      chap /* rearrange as more controls supported - 16 bits should last for a while */
    118  1.18      chap #define PEND_VOL 1
    119  1.18      chap #define PEND_EXP 2
    120  1.18      chap #define PEND_LEVEL (PEND_VOL|PEND_EXP)
    121  1.18      chap #define PEND_PBS 4
    122  1.18      chap #define PEND_TNF 8
    123  1.18      chap #define PEND_TNC 16
    124  1.18      chap #define PEND_PITCH (PEND_PBS|PEND_TNF|PEND_TNC)
    125  1.18      chap #define PEND_ALL   (PEND_LEVEL|PEND_PITCH)
    126  1.18      chap };
    127   1.1  augustss 
    128  1.23  jmcneill static int
    129  1.20  christos midisyn_open(void *addr, int flags, void (*iintr)(void *, int),
    130  1.20  christos     void (*ointr)(void *), void *arg)
    131   1.1  augustss {
    132   1.1  augustss 	midisyn *ms = addr;
    133  1.23  jmcneill 	int rslt, error;
    134  1.18      chap 	uint_fast8_t chan;
    135   1.1  augustss 
    136  1.24    plunky 	KASSERT(ms->lock != NULL);
    137  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    138   1.1  augustss 	DPRINTF(("midisyn_open: ms=%p ms->mets=%p\n", ms, ms->mets));
    139  1.23  jmcneill 
    140  1.23  jmcneill 	mutex_exit(ms->lock);
    141  1.23  jmcneill 	ms->ctl.lock = ms->lock;
    142  1.23  jmcneill 	error = midictl_open(&ms->ctl);
    143  1.23  jmcneill 	if (error != 0) {
    144  1.23  jmcneill 		mutex_enter(ms->lock);
    145  1.23  jmcneill 		return error;
    146  1.23  jmcneill 	}
    147  1.23  jmcneill 	ms->chnstate = kmem_alloc(MIDI_MAX_CHANS * sizeof(*ms->chnstate),
    148  1.23  jmcneill 	    KM_SLEEP); /* init'd by RESET below */
    149  1.23  jmcneill 	mutex_enter(ms->lock);
    150  1.18      chap 
    151  1.18      chap 	rslt = 0;
    152   1.1  augustss 	if (ms->mets->open)
    153  1.18      chap 		rslt = (ms->mets->open(ms, flags));
    154  1.18      chap 
    155  1.18      chap 	/*
    156  1.18      chap 	 * Make the right initial things happen by faking receipt of RESET on
    157  1.18      chap 	 * all channels. The hw driver's ctlnotice() will be called in turn.
    158  1.18      chap 	 */
    159  1.18      chap 	for ( chan = 0 ; chan < MIDI_MAX_CHANS ; ++ chan )
    160  1.18      chap 		midisyn_notify(ms, MIDICTL_RESET, chan, 0);
    161  1.18      chap 
    162  1.18      chap 	return rslt;
    163   1.1  augustss }
    164   1.1  augustss 
    165  1.23  jmcneill static void
    166   1.8  augustss midisyn_close(void *addr)
    167   1.1  augustss {
    168   1.1  augustss 	midisyn *ms = addr;
    169   1.4   mycroft 	struct midisyn_methods *fs;
    170  1.18      chap 	int chan;
    171   1.1  augustss 
    172  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    173   1.1  augustss 	DPRINTF(("midisyn_close: ms=%p ms->mets=%p\n", ms, ms->mets));
    174   1.4   mycroft 	fs = ms->mets;
    175  1.18      chap 
    176  1.18      chap 	for (chan = 0; chan < MIDI_MAX_CHANS; chan++)
    177  1.18      chap 		midisyn_notify(ms, MIDICTL_SOUND_OFF, chan, 0);
    178  1.18      chap 
    179   1.4   mycroft 	if (fs->close)
    180   1.4   mycroft 		fs->close(ms);
    181  1.18      chap 
    182  1.23  jmcneill 	mutex_exit(ms->lock);
    183  1.18      chap 	midictl_close(&ms->ctl);
    184  1.23  jmcneill 	kmem_free(ms->chnstate, MIDI_MAX_CHANS * sizeof(*ms->chnstate));
    185  1.23  jmcneill 	mutex_enter(ms->lock);
    186   1.1  augustss }
    187   1.1  augustss 
    188  1.23  jmcneill static void
    189   1.8  augustss midisyn_getinfo(void *addr, struct midi_info *mi)
    190   1.1  augustss {
    191   1.1  augustss 	midisyn *ms = addr;
    192   1.1  augustss 
    193  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    194  1.23  jmcneill 
    195   1.1  augustss 	mi->name = ms->name;
    196  1.18      chap 	/*
    197  1.18      chap 	 * I was going to add a property here to suppress midi(4)'s warning
    198  1.18      chap 	 * about an output device that uses no transmit interrupt, on the
    199  1.18      chap 	 * assumption that as an onboard synth we handle "output" internally
    200  1.18      chap 	 * with nothing like the 320 us per byte busy wait of a dumb UART.
    201  1.18      chap 	 * Then I noticed that opl (at least as currently implemented) seems
    202  1.18      chap 	 * to need 40 us busy wait to set each register on an OPL2, and sets
    203  1.18      chap 	 * about 21 registers for every note-on. (Half of that is patch loading
    204  1.18      chap 	 * and could probably be reduced by different management of voices and
    205  1.18      chap 	 * patches.) For now I won't bother suppressing that warning....
    206  1.18      chap 	 */
    207   1.1  augustss 	mi->props = 0;
    208  1.18      chap 
    209  1.18      chap 	midi_register_hw_if_ext(&midisyn_hw_if_ext);
    210   1.1  augustss }
    211   1.1  augustss 
    212  1.23  jmcneill static void
    213  1.23  jmcneill midisyn_get_locks(void *addr, kmutex_t **intr, kmutex_t **proc)
    214  1.23  jmcneill {
    215  1.23  jmcneill 	midisyn *ms = addr;
    216  1.23  jmcneill 
    217  1.23  jmcneill 	*intr = ms->lock;
    218  1.23  jmcneill 	*proc = NULL;
    219  1.23  jmcneill }
    220  1.23  jmcneill 
    221  1.23  jmcneill static int
    222  1.21  christos midisyn_ioctl(void *maddr, u_long cmd, void *addr, int flag, struct lwp *l)
    223   1.1  augustss {
    224   1.1  augustss 	midisyn *ms = maddr;
    225   1.1  augustss 
    226  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    227  1.23  jmcneill 
    228   1.1  augustss 	if (ms->mets->ioctl)
    229  1.16  christos 		return (ms->mets->ioctl(ms, cmd, addr, flag, l));
    230   1.1  augustss 	else
    231   1.1  augustss 		return (EINVAL);
    232   1.1  augustss }
    233   1.1  augustss 
    234  1.23  jmcneill static int
    235   1.8  augustss midisyn_findvoice(midisyn *ms, int chan, int note)
    236   1.1  augustss {
    237   1.1  augustss 	u_int cn;
    238   1.1  augustss 	int v;
    239   1.1  augustss 
    240  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    241  1.23  jmcneill 
    242   1.3  augustss 	cn = MS_CHANNOTE(chan, note);
    243   1.1  augustss 	for (v = 0; v < ms->nvoice; v++)
    244   1.3  augustss 		if (ms->voices[v].chan_note == cn && ms->voices[v].inuse)
    245   1.1  augustss 			return (v);
    246   1.1  augustss 	return (-1);
    247   1.1  augustss }
    248   1.1  augustss 
    249   1.1  augustss void
    250  1.24    plunky midisyn_init(midisyn *ms)
    251   1.1  augustss {
    252  1.23  jmcneill 
    253  1.24    plunky 	KASSERT(ms->lock != NULL);
    254  1.23  jmcneill 
    255  1.18      chap 	/*
    256  1.18      chap 	 * XXX there should be a way for this function to indicate failure
    257  1.18      chap 	 * (other than panic) if some preconditions aren't met, for example
    258  1.18      chap 	 * if some nonoptional methods are missing.
    259  1.18      chap 	 */
    260  1.18      chap 	if (ms->mets->allocv == 0) {
    261  1.23  jmcneill 		ms->voices = kmem_zalloc(ms->nvoice * sizeof(struct voice),
    262  1.23  jmcneill 		    KM_SLEEP);
    263   1.1  augustss 		ms->seqno = 1;
    264  1.18      chap 		ms->mets->allocv = midisyn_allocvoice;
    265   1.1  augustss 	}
    266  1.18      chap 
    267  1.18      chap 	if (ms->mets->attackv_vel == 0 && ms->mets->attackv != 0)
    268  1.18      chap 		ms->mets->attackv_vel = midisyn_attackv_vel;
    269  1.18      chap 
    270  1.18      chap 	ms->ctl = (midictl) {
    271  1.18      chap 		.base_channel = 16,
    272  1.18      chap 		.cookie = ms,
    273  1.18      chap 		.notify = midisyn_notify
    274  1.18      chap 	};
    275  1.18      chap 
    276  1.24    plunky 	DPRINTF(("midisyn_init: ms=%p\n", ms));
    277   1.1  augustss }
    278   1.1  augustss 
    279  1.23  jmcneill static void
    280   1.8  augustss midisyn_freevoice(midisyn *ms, int voice)
    281   1.1  augustss {
    282  1.23  jmcneill 
    283  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    284  1.23  jmcneill 
    285  1.18      chap 	if (ms->mets->allocv != midisyn_allocvoice)
    286   1.1  augustss 		return;
    287   1.3  augustss 	ms->voices[voice].inuse = 0;
    288   1.1  augustss }
    289   1.1  augustss 
    290  1.23  jmcneill static uint_fast16_t
    291  1.18      chap midisyn_allocvoice(midisyn *ms, uint_fast8_t chan, uint_fast8_t note)
    292   1.1  augustss {
    293   1.1  augustss 	int bestv, v;
    294   1.1  augustss 	u_int bestseq, s;
    295   1.1  augustss 
    296  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    297  1.23  jmcneill 
    298   1.1  augustss 	/* Find a free voice, or if no free voice is found the oldest. */
    299   1.1  augustss 	bestv = 0;
    300   1.3  augustss 	bestseq = ms->voices[0].seqno + (ms->voices[0].inuse ? 0x40000000 : 0);
    301   1.1  augustss 	for (v = 1; v < ms->nvoice; v++) {
    302   1.1  augustss 		s = ms->voices[v].seqno;
    303   1.3  augustss 		if (ms->voices[v].inuse)
    304   1.3  augustss 			s += 0x40000000;
    305   1.1  augustss 		if (s < bestseq) {
    306   1.1  augustss 			bestseq = s;
    307   1.1  augustss 			bestv = v;
    308   1.1  augustss 		}
    309   1.1  augustss 	}
    310   1.3  augustss 	DPRINTFN(10,("midisyn_allocvoice: v=%d seq=%d cn=%x inuse=%d\n",
    311  1.15     perry 		     bestv, ms->voices[bestv].seqno,
    312   1.3  augustss 		     ms->voices[bestv].chan_note,
    313   1.3  augustss 		     ms->voices[bestv].inuse));
    314   1.3  augustss #ifdef AUDIO_DEBUG
    315   1.3  augustss 	if (ms->voices[bestv].inuse)
    316  1.15     perry 		DPRINTFN(1,("midisyn_allocvoice: steal %x\n",
    317   1.3  augustss 			    ms->voices[bestv].chan_note));
    318   1.3  augustss #endif
    319   1.3  augustss 	ms->voices[bestv].chan_note = MS_CHANNOTE(chan, note);
    320   1.1  augustss 	ms->voices[bestv].seqno = ms->seqno++;
    321   1.3  augustss 	ms->voices[bestv].inuse = 1;
    322   1.1  augustss 	return (bestv);
    323   1.1  augustss }
    324   1.1  augustss 
    325  1.18      chap /* dummy attackv_vel that just adds vel into level for simple drivers */
    326  1.18      chap static void
    327  1.18      chap midisyn_attackv_vel(midisyn *ms, uint_fast16_t voice, midipitch_t mp,
    328  1.18      chap                     int16_t level_cB, uint_fast8_t vel)
    329  1.18      chap {
    330  1.23  jmcneill 
    331  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    332  1.23  jmcneill 
    333  1.18      chap 	ms->voices[voice].velcB = midisyn_vol2cB((uint_fast16_t)vel << 7);
    334  1.18      chap 	ms->mets->attackv(ms, voice, mp, level_cB + ms->voices[voice].velcB);
    335  1.18      chap }
    336  1.18      chap 
    337  1.23  jmcneill static int
    338  1.20  christos midisyn_sysrt(void *addr, int b)
    339  1.18      chap {
    340  1.23  jmcneill 
    341  1.18      chap 	return 0;
    342  1.18      chap }
    343  1.18      chap 
    344  1.23  jmcneill static int
    345  1.23  jmcneill midisyn_channelmsg(void *addr, int status, int chan, u_char *buf, int len)
    346   1.1  augustss {
    347   1.1  augustss 	midisyn *ms = addr;
    348   1.1  augustss 	int voice = 0;		/* initialize to keep gcc quiet */
    349   1.1  augustss 	struct midisyn_methods *fs;
    350   1.1  augustss 
    351  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    352  1.23  jmcneill 
    353  1.18      chap 	DPRINTF(("midisyn_channelmsg: ms=%p status=%#02x chan=%d\n",
    354  1.18      chap 	       ms, status, chan));
    355   1.1  augustss 	fs = ms->mets;
    356  1.18      chap 
    357  1.18      chap 	switch (status) {
    358   1.1  augustss 	case MIDI_NOTEOFF:
    359  1.18      chap 		/*
    360  1.18      chap 		 * for a device that leaves voice allocation to us--and that's
    361  1.18      chap 		 * all of 'em at the moment--the voice and release velocity
    362  1.18      chap 		 * should be the only necessary arguments to noteoff. what use
    363  1.18      chap 		 * are they making of note? checking... None. Cool.
    364  1.18      chap 		 * IF there is ever a device added that does its own allocation,
    365  1.18      chap 		 * extend the interface; this findvoice won't be what to do...
    366  1.18      chap 		 */
    367  1.18      chap 		voice = midisyn_findvoice(ms, chan, buf[1]);
    368   1.1  augustss 		if (voice >= 0) {
    369  1.18      chap 			fs->releasev(ms, voice, buf[2]);
    370   1.1  augustss 			midisyn_freevoice(ms, voice);
    371   1.1  augustss 		}
    372   1.1  augustss 		break;
    373   1.1  augustss 	case MIDI_NOTEON:
    374  1.18      chap 		/*
    375  1.18      chap 		 * what's called for here, given current drivers, is an i/f
    376  1.18      chap 		 * where midisyn computes a volume from vel*volume*expression*
    377  1.18      chap 		 * mastervolume and passes that result as a single arg. It can
    378  1.18      chap 		 * evolve later to support drivers that expose some of those
    379  1.18      chap 		 * bits separately (e.g. a driver could expose a mixer register
    380  1.18      chap 		 * on its sound card and use that for mastervolume).
    381  1.18      chap 		 */
    382  1.18      chap 		voice = fs->allocv(ms, chan, buf[1]);
    383  1.18      chap 		ms->voices[voice].velcB = 0; /* assume driver handles vel */
    384  1.18      chap 		fs->attackv_vel(ms, voice,
    385  1.18      chap 		    midisyn_clamp_pitch(MIDIPITCH_FROM_KEY(buf[1]) +
    386  1.18      chap 		                        midisyn_adj_pitch(ms, chan)),
    387  1.18      chap 		    midisyn_adj_level(ms,chan), buf[2]);
    388   1.1  augustss 		break;
    389   1.1  augustss 	case MIDI_KEY_PRESSURE:
    390  1.18      chap 		/*
    391  1.18      chap 		 * unimplemented by the existing drivers. if we are doing
    392  1.18      chap 		 * voice allocation, find the voice that corresponds to this
    393  1.18      chap 		 * chan/note and define a method that passes the voice and
    394  1.18      chap 		 * pressure to the driver ... not the note, /it/ doesn't matter.
    395  1.18      chap 		 * For a driver that does its own allocation, a different
    396  1.18      chap 		 * method may be needed passing pressure, chan, note so it can
    397  1.18      chap 		 * find the right voice on its own. Be sure that whatever is
    398  1.18      chap 		 * done here is undone when midisyn_notify sees MIDICTL_RESET.
    399  1.18      chap 		 */
    400   1.1  augustss 		break;
    401   1.1  augustss 	case MIDI_CTL_CHANGE:
    402  1.18      chap 		midictl_change(&ms->ctl, chan, buf+1);
    403   1.1  augustss 		break;
    404   1.1  augustss 	case MIDI_PGM_CHANGE:
    405   1.1  augustss 		if (fs->pgmchg)
    406  1.18      chap 			fs->pgmchg(ms, chan, buf[1]);
    407   1.1  augustss 		break;
    408   1.1  augustss 	case MIDI_CHN_PRESSURE:
    409  1.18      chap 		/*
    410  1.18      chap 		 * unimplemented by the existing drivers. if driver exposes no
    411  1.18      chap 		 * distinct method, can use KEY_PRESSURE method for each voice
    412  1.18      chap 		 * on channel. Be sure that whatever is
    413  1.18      chap 		 * done here is undone when midisyn_notify sees MIDICTL_RESET.
    414  1.18      chap 		 */
    415   1.1  augustss 		break;
    416   1.1  augustss 	case MIDI_PITCH_BEND:
    417  1.18      chap 		/*
    418  1.18      chap 		 * Will work for most drivers that simply render the midipitch
    419  1.18      chap 		 * as we pass it (but not cms, which chops all the bits after
    420  1.18      chap 		 * the note number and then computes its own pitch :( ). If the
    421  1.18      chap 		 * driver has a repitchv method for voices already sounding, so
    422  1.18      chap 		 * much the better.
    423  1.18      chap 		 * The bending logic lives in the handler for bend sensitivity,
    424  1.18      chap 		 * so fake a change to that to kick it off.
    425  1.18      chap 		 */
    426  1.18      chap 		ms->chnstate[chan].bendraw = buf[2]<<7 | buf[1];
    427  1.18      chap 		ms->chnstate[chan].bendraw -= MIDI_BEND_NEUTRAL;
    428  1.18      chap 		midisyn_notify(ms, MIDICTL_RPN, chan,
    429  1.18      chap 		               MIDI_RPN_PITCH_BEND_SENSITIVITY);
    430   1.1  augustss 		break;
    431   1.1  augustss 	}
    432  1.18      chap 	return 0;
    433   1.1  augustss }
    434   1.1  augustss 
    435  1.23  jmcneill static int
    436  1.23  jmcneill midisyn_commonmsg(void *addr, int status, u_char *buf, int len)
    437   1.1  augustss {
    438  1.23  jmcneill 
    439  1.18      chap 	return 0;
    440  1.18      chap }
    441   1.1  augustss 
    442  1.23  jmcneill static int
    443  1.23  jmcneill midisyn_sysex(void *addr, u_char *buf, int len)
    444  1.18      chap {
    445  1.23  jmcneill 
    446  1.18      chap 	/*
    447  1.18      chap 	 * unimplemented by existing drivers. it is surely more sensible
    448  1.18      chap 	 * to do some parsing of well-defined sysex messages here, either
    449  1.18      chap 	 * handling them internally or calling specific methods on the
    450  1.18      chap 	 * driver after parsing out the details, than to ask every driver
    451  1.18      chap 	 * to deal with sysex messages poked at it a byte at a time.
    452  1.18      chap 	 */
    453  1.18      chap 	return 0;
    454  1.18      chap }
    455  1.18      chap 
    456  1.18      chap static void
    457  1.18      chap midisyn_notify(void *cookie, midictl_evt evt,
    458  1.18      chap                uint_fast8_t chan, uint_fast16_t key)
    459  1.18      chap {
    460  1.18      chap 	struct midisyn *ms;
    461  1.18      chap 	int drvhandled;
    462  1.18      chap 
    463  1.18      chap 	ms = (struct midisyn *)cookie;
    464  1.23  jmcneill 
    465  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    466  1.23  jmcneill 
    467  1.18      chap 	drvhandled = 0;
    468  1.18      chap 	if ( ms->mets->ctlnotice )
    469  1.18      chap 		drvhandled = ms->mets->ctlnotice(ms, evt, chan, key);
    470  1.18      chap 
    471  1.18      chap 	switch ( evt | key ) {
    472  1.18      chap 	case MIDICTL_RESET:
    473  1.18      chap 		/*
    474  1.18      chap 		 * Re-read all ctls we use, revert pitchbend state.
    475  1.18      chap 		 * Can do it by faking change notifications.
    476  1.18      chap 		 */
    477  1.18      chap 		ms->chnstate[chan].pendingreset |= PEND_ALL;
    478  1.18      chap 		midisyn_notify(ms, MIDICTL_CTLR, chan,
    479  1.18      chap 		               MIDI_CTRL_CHANNEL_VOLUME_MSB);
    480  1.18      chap 		midisyn_notify(ms, MIDICTL_CTLR, chan,
    481  1.18      chap 		               MIDI_CTRL_EXPRESSION_MSB);
    482  1.18      chap 		ms->chnstate[chan].bendraw = 0; /* MIDI_BEND_NEUTRAL - itself */
    483  1.18      chap 		midisyn_notify(ms, MIDICTL_RPN, chan,
    484  1.18      chap 		               MIDI_RPN_PITCH_BEND_SENSITIVITY);
    485  1.18      chap 		midisyn_notify(ms, MIDICTL_RPN, chan,
    486  1.18      chap 		               MIDI_RPN_CHANNEL_FINE_TUNING);
    487  1.18      chap 		midisyn_notify(ms, MIDICTL_RPN, chan,
    488  1.18      chap 		               MIDI_RPN_CHANNEL_COARSE_TUNING);
    489  1.18      chap 		break;
    490  1.18      chap 	case MIDICTL_NOTES_OFF:
    491  1.18      chap 		if ( drvhandled )
    492  1.18      chap 			break;
    493  1.18      chap 		/* releasev all voices sounding on chan; use normal vel 64 */
    494  1.18      chap 		midisyn_chan_releasev(ms, chan, 64);
    495  1.18      chap 		break;
    496  1.18      chap 	case MIDICTL_SOUND_OFF:
    497  1.18      chap 		if ( drvhandled )
    498  1.18      chap 			break;
    499  1.18      chap 		/* releasev all voices sounding on chan; use max vel 127 */
    500  1.18      chap 		/* it is really better for driver to handle this, instantly */
    501  1.18      chap 		midisyn_chan_releasev(ms, chan, 127);
    502  1.18      chap 		break;
    503  1.18      chap 	case MIDICTL_CTLR | MIDI_CTRL_CHANNEL_VOLUME_MSB:
    504  1.18      chap 		ms->chnstate[chan].pendingreset &= ~PEND_VOL;
    505  1.18      chap 		if ( drvhandled ) {
    506  1.18      chap 			ms->chnstate[chan].volume = 0;
    507  1.18      chap 			break;
    508  1.18      chap 		}
    509  1.18      chap 		ms->chnstate[chan].volume = midisyn_vol2cB(
    510  1.18      chap 	    	    midictl_read(&ms->ctl, chan, key, 100<<7));
    511  1.18      chap 		midisyn_upd_level(ms, chan);
    512  1.18      chap 		break;
    513  1.18      chap 	case MIDICTL_CTLR | MIDI_CTRL_EXPRESSION_MSB:
    514  1.18      chap 		ms->chnstate[chan].pendingreset &= ~PEND_EXP;
    515  1.18      chap 		if ( drvhandled ) {
    516  1.18      chap 			ms->chnstate[chan].expression = 0;
    517  1.18      chap 			break;
    518  1.18      chap 		}
    519  1.18      chap 		ms->chnstate[chan].expression = midisyn_vol2cB(
    520  1.18      chap 	    	    midictl_read(&ms->ctl, chan, key, 16383));
    521  1.18      chap 		midisyn_upd_level(ms, chan);
    522  1.18      chap 		break;
    523  1.18      chap 	/*
    524  1.18      chap 	 * SOFT_PEDAL: supporting this will be trickier; must apply only
    525  1.18      chap 	 * to notes subsequently struck, and must remember which voices
    526  1.18      chap 	 * they are for follow-on adjustments. For another day....
    527  1.18      chap 	 */
    528  1.18      chap 	case MIDICTL_RPN | MIDI_RPN_PITCH_BEND_SENSITIVITY:
    529  1.18      chap 		ms->chnstate[chan].pendingreset &= ~PEND_PBS;
    530  1.18      chap 		if ( drvhandled )
    531  1.18      chap 			ms->chnstate[chan].bend = 0;
    532  1.18      chap 		else {
    533  1.18      chap 			uint16_t w;
    534  1.18      chap 			int8_t semis, cents;
    535  1.18      chap 			w = midictl_rpn_read(&ms->ctl, chan, key, 2<<7);
    536  1.18      chap 			semis = w>>7;
    537  1.18      chap 			cents = w&0x7f;
    538  1.18      chap 			/*
    539  1.18      chap 			 * Mathematically, multiply semis by
    540  1.18      chap 			 * MIDIPITCH_SEMITONE*bendraw/8192. Practically, avoid
    541  1.18      chap 			 * shifting significant bits off by observing that
    542  1.18      chap 			 * MIDIPITCH_SEMITONE == 1<<14 and 8192 == 1<<13, so
    543  1.18      chap 			 * just take semis*bendraw<<1. Do the same with cents
    544  1.18      chap 			 * except <<1 becomes /50 (but rounded).
    545  1.18      chap 			 */
    546  1.18      chap 			ms->chnstate[chan].bend =
    547  1.18      chap 			    ( ms->chnstate[chan].bendraw * semis ) << 1;
    548  1.18      chap 			ms->chnstate[chan].bend +=
    549  1.18      chap 			    ((ms->chnstate[chan].bendraw * cents)/25 + 1) >> 1;
    550  1.18      chap 			midisyn_upd_pitch(ms, chan);
    551  1.18      chap 		}
    552  1.18      chap 		break;
    553  1.18      chap 	case MIDICTL_RPN | MIDI_RPN_CHANNEL_FINE_TUNING:
    554  1.18      chap 		if ( drvhandled )
    555  1.18      chap 			ms->chnstate[chan].tuning_fine = 0;
    556  1.18      chap 		else {
    557  1.18      chap 			midipitch_t mp;
    558  1.18      chap 			mp = midictl_rpn_read(&ms->ctl, chan, key, 8192);
    559  1.18      chap 			/*
    560  1.18      chap 			 * Mathematically, subtract 8192 and scale by
    561  1.18      chap 			 * MIDIPITCH_SEMITONE/8192. Practically, subtract 8192
    562  1.18      chap 			 * and then << 1.
    563  1.18      chap 			 */
    564  1.18      chap 			ms->chnstate[chan].tuning_fine = ( mp - 8192 ) << 1;
    565  1.18      chap 			midisyn_upd_pitch(ms, chan);
    566  1.18      chap 		}
    567  1.18      chap 		break;
    568  1.18      chap 	case MIDICTL_RPN | MIDI_RPN_CHANNEL_COARSE_TUNING:
    569  1.18      chap 		ms->chnstate[chan].pendingreset &= ~PEND_TNC;
    570  1.18      chap 		if ( drvhandled )
    571  1.18      chap 			ms->chnstate[chan].tuning_coarse = 0;
    572  1.18      chap 		else {
    573  1.18      chap 			midipitch_t mp;
    574  1.18      chap 			/*
    575  1.18      chap 			 * By definition only the MSB of this parameter is used.
    576  1.18      chap 			 * Subtract 64 for a signed count of semitones; << 14
    577  1.18      chap 			 * will convert to midipitch scale.
    578  1.18      chap 			 */
    579  1.18      chap 			mp = midictl_rpn_read(&ms->ctl, chan, key, 64<<7) >> 7;
    580  1.18      chap 			ms->chnstate[chan].tuning_coarse = ( mp - 64 ) << 14;
    581  1.18      chap 			midisyn_upd_pitch(ms, chan);
    582  1.18      chap 		}
    583  1.18      chap 		break;
    584  1.18      chap 	}
    585  1.18      chap }
    586   1.1  augustss 
    587  1.18      chap static midipitch_t
    588  1.18      chap midisyn_clamp_pitch(midipitch_t mp)
    589  1.18      chap {
    590  1.23  jmcneill 
    591  1.18      chap 	if ( mp <= 0 )
    592  1.18      chap 		return 0;
    593  1.18      chap 	if ( mp >= MIDIPITCH_MAX )
    594  1.18      chap 		return MIDIPITCH_MAX;
    595  1.18      chap 	return mp;
    596  1.18      chap }
    597  1.18      chap 
    598  1.18      chap static int16_t
    599  1.18      chap midisyn_adj_level(midisyn *ms, uint_fast8_t chan)
    600  1.18      chap {
    601  1.18      chap 	int32_t level;
    602  1.23  jmcneill 
    603  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    604  1.18      chap 
    605  1.18      chap 	level = ms->chnstate[chan].volume + ms->chnstate[chan].expression;
    606  1.18      chap 	if ( level <= INT16_MIN )
    607  1.18      chap 		return INT16_MIN;
    608  1.18      chap 	return level;
    609  1.18      chap }
    610  1.18      chap 
    611  1.18      chap static midipitch_t
    612  1.18      chap midisyn_adj_pitch(midisyn *ms, uint_fast8_t chan)
    613  1.18      chap {
    614  1.18      chap 	struct channelstate *s = ms->chnstate + chan;
    615  1.23  jmcneill 
    616  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    617  1.23  jmcneill 
    618  1.18      chap 	return s->bend + s->tuning_fine +s->tuning_coarse;
    619  1.18      chap }
    620  1.18      chap 
    621  1.18      chap #define VOICECHAN_FOREACH_BEGIN(ms,vp,ch)			\
    622  1.18      chap 	{							\
    623  1.18      chap 		struct voice *vp, *_end_##vp;			\
    624  1.18      chap 		for (vp=(ms)->voices,_end_##vp=vp+(ms)->nvoice;	\
    625  1.18      chap 		    vp < _end_##vp; ++ vp) {			\
    626  1.18      chap 			if ( !vp->inuse )			\
    627  1.18      chap 				continue;			\
    628  1.18      chap 			if ( MS_GETCHAN(vp) == (ch) )		\
    629  1.18      chap 				;				\
    630  1.18      chap 			else					\
    631  1.18      chap 				continue;
    632  1.18      chap #define VOICECHAN_FOREACH_END }}
    633  1.18      chap 
    634  1.18      chap static void
    635  1.18      chap midisyn_chan_releasev(midisyn *ms, uint_fast8_t chan, uint_fast8_t vel)
    636  1.18      chap {
    637  1.23  jmcneill 
    638  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    639  1.23  jmcneill 
    640  1.18      chap 	VOICECHAN_FOREACH_BEGIN(ms,vp,chan)
    641  1.18      chap 		ms->mets->releasev(ms, vp - ms->voices, vel);
    642  1.18      chap 		midisyn_freevoice(ms, vp - ms->voices);
    643  1.18      chap 	VOICECHAN_FOREACH_END
    644  1.18      chap }
    645  1.18      chap 
    646  1.18      chap static void
    647  1.18      chap midisyn_upd_level(midisyn *ms, uint_fast8_t chan)
    648  1.18      chap {
    649  1.18      chap 	int32_t level;
    650  1.18      chap 	int16_t chan_level;
    651  1.23  jmcneill 
    652  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    653  1.23  jmcneill 
    654  1.18      chap 	if ( NULL == ms->mets->relevelv )
    655  1.18      chap 		return;
    656  1.18      chap 
    657  1.18      chap 	if ( ms->chnstate[chan].pendingreset & PEND_LEVEL )
    658  1.18      chap 		return;
    659   1.1  augustss 
    660  1.18      chap 	chan_level = midisyn_adj_level(ms, chan);
    661  1.18      chap 
    662  1.18      chap 	VOICECHAN_FOREACH_BEGIN(ms,vp,chan)
    663  1.18      chap 		level = vp->velcB + chan_level;
    664  1.18      chap 		ms->mets->relevelv(ms, vp - ms->voices,
    665  1.18      chap 		    level <= INT16_MIN ? INT16_MIN : level);
    666  1.18      chap 	VOICECHAN_FOREACH_END
    667  1.18      chap }
    668   1.1  augustss 
    669  1.18      chap static void
    670  1.18      chap midisyn_upd_pitch(midisyn *ms, uint_fast8_t chan)
    671  1.18      chap {
    672  1.18      chap 	midipitch_t chan_adj;
    673  1.23  jmcneill 
    674  1.23  jmcneill 	KASSERT(mutex_owned(ms->lock));
    675  1.18      chap 
    676  1.18      chap 	if ( NULL == ms->mets->repitchv )
    677  1.18      chap 		return;
    678  1.18      chap 
    679  1.18      chap 	if ( ms->chnstate[chan].pendingreset & PEND_PITCH )
    680  1.18      chap 		return;
    681   1.3  augustss 
    682  1.18      chap 	chan_adj = midisyn_adj_pitch(ms, chan);
    683  1.18      chap 
    684  1.18      chap 	VOICECHAN_FOREACH_BEGIN(ms,vp,chan)
    685  1.18      chap 		ms->mets->repitchv(ms, vp - ms->voices,
    686  1.18      chap 		    midisyn_clamp_pitch(chan_adj +
    687  1.18      chap 		        MIDIPITCH_FROM_KEY(vp->chan_note&0x7f)));
    688  1.18      chap 	VOICECHAN_FOREACH_END
    689  1.18      chap }
    690  1.18      chap 
    691  1.18      chap #undef VOICECHAN_FOREACH_END
    692  1.18      chap #undef VOICECHAN_FOREACH_BEGIN
    693  1.18      chap 
    694  1.18      chap int16_t
    695  1.18      chap midisyn_vol2cB(uint_fast16_t vol)
    696  1.18      chap {
    697  1.18      chap 	int16_t cB = 0;
    698  1.18      chap 	int32_t v;
    699  1.18      chap 
    700  1.18      chap 	if ( 0 == vol )
    701  1.18      chap 		return INT16_MIN;
    702  1.18      chap 	/*
    703  1.18      chap 	 * Adjust vol to fall in the range 8192..16383. Each doubling is
    704  1.18      chap 	 * worth 12 dB.
    705  1.18      chap 	 */
    706  1.18      chap 	while ( vol < 8192 ) {
    707  1.18      chap 		vol <<= 1;
    708  1.18      chap 		cB -= 120;
    709   1.3  augustss 	}
    710  1.18      chap 	v = vol; /* ensure evaluation in signed 32 bit below */
    711  1.18      chap 	/*
    712  1.18      chap 	 * The GM vol-to-dB formula is dB = 40 log ( v / 127 ) for 7-bit v.
    713  1.18      chap 	 * The vol and expression controllers are in 14-bit space so the
    714  1.18      chap 	 * equivalent is 40 log ( v / 16256 ) - that is, MSB 127 LSB 0 because
    715  1.18      chap 	 * the LSB is commonly unused. MSB 127 LSB 127 would then be a tiny
    716  1.18      chap 	 * bit over.
    717  1.18      chap 	 * 1 dB resolution is a little coarser than we'd like, so let's shoot
    718  1.18      chap 	 * for centibels, i.e. 400 log ( v / 16256 ), and shift everything left
    719  1.18      chap 	 * as far as will fit in 32 bits, which turns out to be a shift of 22.
    720  1.18      chap 	 * This minimax polynomial approximation is good to about a centibel
    721  1.18      chap 	 * on the range 8192..16256, a shade worse (1.4 or so) above that.
    722  1.18      chap 	 * 26385/10166 is the 6th convergent of the coefficient for v^2.
    723  1.18      chap 	 */
    724  1.18      chap 	cB += ( v * ( 124828 - ( v * 26385 ) / 10166 ) - 1347349038 ) >> 22;
    725  1.18      chap 	return cB;
    726  1.18      chap }
    727   1.3  augustss 
    728  1.18      chap /*
    729  1.18      chap  * MIDI RP-012 constitutes a MIDI Tuning Specification. The units are
    730  1.18      chap  * fractional-MIDIkeys, that is, the key number 00 - 7f left shifted
    731  1.18      chap  * 14 bits to provide a 14-bit fraction that divides each semitone. The
    732  1.18      chap  * whole thing is just a 21-bit number that is bent and tuned simply by
    733  1.18      chap  * adding and subtracting--the same offset is the same pitch change anywhere
    734  1.18      chap  * on the scale. One downside is that a cent is 163.84 of these units, so
    735  1.18      chap  * you can't expect a lengthy integer sum of cents to come out in tune; if you
    736  1.18      chap  * do anything in cents it is best to use them only for local adjustment of
    737  1.18      chap  * a pitch.
    738  1.18      chap  *
    739  1.18      chap  * This function converts a pitch in MIDItune units to Hz left-shifted 18 bits.
    740  1.18      chap  * That should leave you enough to shift down to whatever precision the hardware
    741  1.18      chap  * supports.
    742  1.18      chap  *
    743  1.18      chap  * Its prototype is exposed in <sys/midiio.h>.
    744  1.18      chap  */
    745  1.18      chap midihz18_t
    746  1.18      chap midisyn_mp2hz18(midipitch_t mp)
    747  1.18      chap {
    748  1.18      chap 	int64_t t64a, t64b;
    749  1.18      chap 	uint_fast8_t shift;
    750  1.18      chap 
    751  1.18      chap 	/*
    752  1.18      chap 	 * Scale from the logarithmic MIDI-Tuning units to Hz<<18. Uses the
    753  1.18      chap 	 * continued-fraction form of a 2/2 rational function derived to
    754  1.18      chap 	 * cover the highest octave (mt 1900544..2097151 or 74.00.00..7f.7f.7f
    755  1.18      chap 	 * in RP-012-speak, the dotted bits are 7 wide) to produce Hz shifted
    756  1.18      chap 	 * left just as far as the maximum Hz will fit in a uint32, which
    757  1.18      chap 	 * turns out to be 18. Just shift off the result for lower octaves.
    758  1.18      chap 	 * Fit is within 1/4 MIDI tuning unit throughout (disclaimer: the
    759  1.18      chap 	 * comparison relied on the double-precision log in libm).
    760  1.18      chap 	 */
    761  1.18      chap 
    762  1.18      chap 	if ( 0 == mp )
    763  1.18      chap 		return 2143236;
    764  1.18      chap 
    765  1.18      chap 	for ( shift = 0; mp < 1900544; ++ shift )
    766  1.18      chap 		mp += MIDIPITCH_OCTAVE;
    767  1.18      chap 
    768  1.18      chap 	if ( 1998848 == mp )
    769  1.18      chap 		return UINT32_C(2463438621) >> shift;
    770  1.18      chap 
    771  1.18      chap 	t64a  = 0x5a1a0ee4; /* INT64_C(967879298788) gcc333: spurious warning */
    772  1.18      chap 	t64a |= (int64_t)0xe1 << 32;
    773  1.18      chap 	t64a /= mp - 1998848; /* here's why 1998848 is special-cased above ;) */
    774  1.18      chap 	t64a += mp - 3704981;
    775  1.18      chap 	t64b  = 0x6763759d; /* INT64_C(8405905567872413) goofy warning again */
    776  1.18      chap 	t64b |= (int64_t)0x1ddd20 << 32;
    777  1.18      chap 	t64b /= t64a;
    778  1.18      chap 	t64b += UINT32_C(2463438619);
    779  1.18      chap 	return (uint32_t)t64b >> shift;
    780   1.1  augustss }
    781