source: buchla-68k/ram/sendval.c@ de91266

/*
   =============================================================================
        sendval.c -- MIDAS-VII -- FPU output and clear functions
        Version 4 -- 1988-09-27 -- D.N. Lynx Crowe
   =============================================================================
*/

#include "ram.h"

/*
   =============================================================================
        sendval() -- send a value to a voice parameter
   =============================================================================
*/

void sendval(int16_t voice, int16_t par, int16_t ival)
{
        volatile uint16_t *fpu;
        int16_t oldi, val;
        int32_t ltmp;
        int16_t nop;

        fpu = io_fpu + FPU_OFNC + (voice << 8) + (par << 4);

        switch (par) {

        case 1:         /* freq 1 */
        case 3:         /* freq 2 */
        case 5:         /* freq 3 */
        case 7:         /* freq 4 */

                val = addpch(ival, 0);
                break;

        case 4:         /* location */

                val = (ival << 1) ^ 0x8000;
                break;

        case 10:        /* filter */

                ltmp = ((int32_t)ival >> 1) + ((int32_t)ival >>2);

                if (ltmp GT (int32_t)VALMAX)
                        ltmp = (int32_t)VALMAX;
                else if (ltmp LT (int32_t)VALMIN)
                        ltmp = (int32_t)VALMIN;

                val = (int16_t)ltmp;
                break;

        case 2:         /* level */

                val = (((int16_t)ival >> 5) - 500) << 6;
                break;

        default:

                val = ival;
        }

        oldi = setipl(FPU_DI);

/* ++++++++++++++++++++++++++++ FPU interrupts disabled +++++++++++++++++++++ */

        *(fpu + (int32_t)FPU_TNV0) = val;
        ++nop;  ++nop;  ++nop;
        *(fpu + (int32_t)FPU_TNV1) = val;
        ++nop;  ++nop;  ++nop;
        *(fpu + (int32_t)FPU_TCTL) = 0x0015;

        setipl(oldi);

/* ++++++++++++++++++++++++++++ Interrupts restored +++++++++++++++++++++++++ */

}

/*
   =============================================================================
        clearer() -- clear the FPU
   =============================================================================
*/

void clearer(int16_t stat)
{
        volatile uint16_t *fpu;
        uint16_t fpexp, fpmant, fptime;
        int16_t oldi, i;
        int16_t nop, olds;

        if (stat) {

                fp_resv[0]  = 0x8300;                   /* amplitude (off) */
                fp_resv[1]  = (ps_intn * 10) << 5;      /* intensity */
                fp_resv[2]  = (ps_rate * 10) << 5;      /* sweep rate */
                fp_resv[3]  = (ps_dpth * 10) << 5;      /* sweep depth */
                fp_resv[4]  = 0;                        /* - unused - */
                fp_resv[5]  = 0;                        /* - unused - */
                fp_resv[6]  = ext_cv3;                  /* CV-3 */
                fp_resv[7]  = 0;                        /* - unused - */
                fp_resv[8]  = ext_cv4;                  /* CV-4 */
                fp_resv[9]  = ext_mod;                  /* Aux Signal Mod */
                fp_resv[10] = ext_cv2;                  /* CV-2 */
                fp_resv[11] = ext_cv1;                  /* CV-1 */

                fpu    = io_fpu + FPU_OFNC;     /* setup to set slew rate */
                fptime = tofpu(AMP_TIME);
                fpexp  = expbit[fptime & 0x000F];
                fpmant = fptime & 0xFFF0;

                oldi = setipl(FPU_DI);          /* disable FPU interrupts */

/* ++++++++++++++++++++++++++++ FPU interrupts disabled +++++++++++++++++++++ */

                fpuclr();                       /* reset the FPU to nominal */

                *(fpu + FPU_TMNT) = fpmant;     /* set amplitude slew rate */
                ++nop;  ++nop;
                *(fpu + FPU_TEXP) = fpexp;

                /* reset execution control tables */

                memset(trgtab,   0, NTRIGS);            /* trigger table */
                memset(keystat,  0, 24);                /* local key status */

                memsetw(prstab,  0, NTRIGS);            /* pressure table */
                memsetw(veltab, SM_SCALE(64), NTRIGS);  /* velocity table */

                clrpfl();                       /* clear pendant functions */

                for (i = 0; i < 48; i++)        /* sustain pedal table */
                        mpsust[i] = 0;

                for (i = 0; i < 12; i++) {

                        vce2trg[i] = -1;        /* voice to trigger table */
                        lastvce[i] = 0;         /* last voice used table */
                }

                olds = sliders;                 /* reset articulation pots */
                sliders = LS_PRMTR;
                l_init(1, 0);
                sliders = LS_OTHER;
                l_init(1, 0);
                sliders = olds;

                setipl(oldi);                   /* restore interrupts */

/* ++++++++++++++++++++++++++++ Interrupts restored +++++++++++++++++++++++++ */


                lstbgnc = 0;            /* reset last note begin count */
                lstendc = 0;            /* reset last note end count */

                memsetw(lstbgns, 0, (NLSTENTS << 1));   /* clear begin table */
                memsetw(lstends, 0, (NLSTENTS << 1));   /* clear end table */

                /* re-establish dynamics and locations */

                for (i = 0; i < 12; i++) {

                        setdyn(i, grpdyn[i]);
                        setloc(i, grploc[i]);
                }

                settune();                      /* set tuning */
                sendval(0, 0, amplval);         /* set amplitude */
        }
}