File content as of revision 18:1bf4abf6895b:

/*
 * KIK01
 * Kick Machine
 *
 * 2017.09.16 Proto04: SPI1 for AD8402 Wein Bridge DCO & Internal DAC for Dual-OTA-VCA
 * 2017.07.04 Proto03: MCP4922 DCA
 * 2017.06.19 Proto02
 * 2017.06.04 created.
 *
 */

#include "mbed.h"
#include "rtos.h"
#include "mcp3008.h"

#define UART_TRACE      (1)
#define PIN_CHECK       (1)
#define TITLE_STR1      ("KIK01 Kick Machine")
#define TITLE_STR2      ("20170916")

#define PI_F            (3.1415926f)

#define MCP3008_SPI_SPEED       (1000000)
#define AD8402_SPI_SPEED        (4000000)
#define ENVELOPE_UPDATE_RATE    (10000)  //  Hz

AnalogOut Dac1(A2);

// AD8402 SPI
SPI SpiM1(SPI_MOSI, SPI_MISO, SPI_SCK);
DigitalOut AD8402Cs(D10);

// MCP3008 SPI
SPI SpiM3(D4, D5, D3);
MCP3008 Adc0(&SpiM3, D6);
MCP3008 Adc1(&SpiM3, D7);

// Sync
DigitalOut SyncPin(D2);

// Check pins
DigitalOut Dout0(D8);
DigitalOut Dout1(D9);
DigitalOut Dout2(D14);

class EnvelopeAR
{
public:
    EnvelopeAR(int _attack, int _release, float _v0, float _v1, float _v2, float _attackTauRatio=0.36f, float _releaseTauRatio=0.36f) :
        amplitude(_v0),
        v0(_v0),
        v1(_v1),
        v2(_v2),
        vLast(_v0),
        attackTauRatio(_attackTauRatio),
        releaseTauRatio(_releaseTauRatio) {
        setAttack(_attack);
        setRelease(_release);
    }

    ~EnvelopeAR() {}

    void setAttack(int _attack) {
        attack = _attack;
        tau0 = attack * attackTauRatio;
    }
    int getAttack() {
        return attack;
    }

    void setRelease(int _release) {
        release = _release;
        tau1 = release * releaseTauRatio;
    }
    int getRelease() {
        return release;
    }

    void setAttackTauRatio(float _attackTauRatio) {
        attackTauRatio = _attackTauRatio;
        tau0 = attack * attackTauRatio;
    }
    float getAttackTauRatio() {
        return attackTauRatio;
    }

    void setReleaseTauRatio(float _releaseTauRatio) {
        releaseTauRatio = _releaseTauRatio;
        tau1 = release * releaseTauRatio;
    }
    float getReleaseTauRatio() {
        return releaseTauRatio;
    }

    float getTau0() {
        return tau0;
    }
    float getTau1() {
        return tau1;
    }

    void setV0(float _v0) {
        v0 = _v0;
    }
    float getV0() {
        return v0;
    }
    void setV1(float _v1) {
        v1 = _v1;
    }
    float getV1() {
        return v1;
    }
    void setV2(float _v2) {
        v2 = _v2;
    }
    float getV2() {
        return v2;
    }

    float getAmplitude() {
        return amplitude;
    }
    float getAmplitude(int tick) {
        if (tick < attack) {
            // attackの処理
            amplitude = v0 + (v1 - v0) * (1 - expf(-(float)tick / tau0));
            vLast = amplitude;
        } else {
            // releaseの処理
            amplitude = (vLast - v2) * (expf(-(float)(tick - attack) / tau1)) + v2;
        }
        return amplitude;
    }

private:
    int attack;
    int release;
    float amplitude;
    float v0;
    float v1;
    float v2;
    float vLast;
    float tau0;
    float tau1;
    float attackTauRatio;
    float releaseTauRatio;
};

class EnvelopeParam
{
public:
    int attack;
    int release;
    float v0;
    float v1;
    float v2;
    float attackTauRatio;
    float releaseTauRatio;
};

EnvelopeAR envelopeFrequency(5, 300, 880.0f, 120.0f, 40.0f, 0.36f, 0.1f);
EnvelopeAR envelopeAmplitude(50, 200, 0.99f, 1.0f, 0.0f);

volatile EnvelopeParam frequencyParam;
volatile EnvelopeParam amplitudeParam;

volatile int ticks;
volatile float frequency;
volatile float amplitude;

volatile float bpm;
volatile int envelopeLength;
volatile int stepLength;

#if 0
//-----------------------------------------------------------------------------//
// Internal DCA
//
void generateWave_DcaInternal()
{
    phi += phiDelta;
    if (phi >= 1.0f) {
        phi -= 2.0f;
    }
    float level = cosf(PI_F * phi) * amplitude;

    Dac1.write((level * 0.7f + 1.0f) / 2.0f);
}

void generateEnvelope_DcaInternal()
{
    // Frequency Envelope
    frequency = envelopeFrequency.getAmplitude(envelopeTicks);
    phiDelta = 2.0f * frequency / SAMPLING_RATE;

    // Amplitude Envelope
    amplitude = envelopeAmplitude.getAmplitude(envelopeTicks);

    envelopeTicks++;
    if (envelopeTicks >= envelopeLength) {
        envelopeTicks = 0;
        phi = PI_F / 2.0f;
    }
}

//-----------------------------------------------------------------------------//
// External DCA
//
void generateWave_DcaExternal()
{
    phi += phiDelta;
    if (phi >= 1.0f) {
        phi -= 2.0f;
    }
    //float level = cosf(PI_F * phi) * amplitude;
    float level = cosf(PI_F * phi);

    Dac1.write((level * 0.7f + 1.0f) / 2.0f);
}

void generateEnvelope_DcaExternal()
{
    // Frequency Envelope
    frequency = envelopeFrequency.getAmplitude(envelopeTicks);
    phiDelta = 2.0f * frequency / SAMPLING_RATE;

    // Amplitude Envelope
    amplitude = envelopeAmplitude.getAmplitude(envelopeTicks);

    ampController.outDca(amplitude * 4096);

    envelopeTicks++;
    if (envelopeTicks >= envelopeLength) {
        envelopeTicks = 0;
        phi = PI_F / 2.0f;
    }
}
#endif

void AD8402Write(uint8_t address, uint8_t value)
{
    AD8402Cs = 0;
    SpiM1.write(address);
    SpiM1.write(value);
    AD8402Cs = 1;
    wait_us(1);
}

void DcoSetFrequency()
{
#if (PIN_CHECK)
    Dout1 = 1;
#endif

    frequency = envelopeFrequency.getAmplitude(ticks);
    const float c = 0.00000047;
    float r = 1.0f / (2.0f * PI_F * frequency * c);
    uint8_t v = 256.0f * (r - 50.0f) / 10000.0f;
    
    AD8402Write(0, v);
    AD8402Write(1, v);

#if (PIN_CHECK)
    Dout1 = 0;
#endif
}

void update()
{
#if (PIN_CHECK)
    Dout0 = 1;
#endif

    // Output Sync Signal per steps
    if (ticks % stepLength == 0) {
        SyncPin = 1;
    }

    // set envelope parameters
    envelopeAmplitude.setAttack(amplitudeParam.attack);
    envelopeAmplitude.setRelease(amplitudeParam.release);
    envelopeAmplitude.setV0(amplitudeParam.v0);
    envelopeAmplitude.setV1(amplitudeParam.v1);
    envelopeAmplitude.setV2(amplitudeParam.v2);
    envelopeAmplitude.setAttackTauRatio(amplitudeParam.attackTauRatio);
    envelopeAmplitude.setReleaseTauRatio(amplitudeParam.releaseTauRatio);

    envelopeFrequency.setAttack(frequencyParam.attack);
    envelopeFrequency.setRelease(frequencyParam.release);
    envelopeFrequency.setV0(frequencyParam.v0);
    envelopeFrequency.setV1(frequencyParam.v1);
    envelopeFrequency.setV2(frequencyParam.v2);
    envelopeFrequency.setAttackTauRatio(frequencyParam.attackTauRatio);
    envelopeFrequency.setReleaseTauRatio(frequencyParam.releaseTauRatio);

    DcoSetFrequency();

    ticks++;
    if (ticks >= envelopeLength) {
        ticks = 0;
    }

    // Output SyncSignal
    SyncPin = 0;

#if (PIN_CHECK)
    Dout0 = 0;
#endif
}

void setParams()
{
    bpm = Adc0.read_input(7) * 180.0f + 60.0f;
    envelopeLength = 60 * ENVELOPE_UPDATE_RATE / bpm;
    stepLength = envelopeLength / 4;

    amplitudeParam.attack = Adc0.read_input(0) * envelopeLength;
    amplitudeParam.release = Adc0.read_input(1) * envelopeLength;
    amplitudeParam.v0 = Adc0.read_input(4);
    amplitudeParam.v1 = Adc0.read_input(5);
    amplitudeParam.v2 = Adc0.read_input(6);
    amplitudeParam.attackTauRatio = 0.36f;
    amplitudeParam.releaseTauRatio = Adc0.read_input(3) + 0.01f;

    frequencyParam.attack = Adc1.read_input(0) * envelopeLength * 0.1f;
    frequencyParam.release = Adc1.read_input(1) * envelopeLength + 1;
    frequencyParam.v0 = Adc1.read_input(4) * 4000.0f;
    frequencyParam.v1 = Adc1.read_input(5) * 400.0f;
    frequencyParam.v2 = Adc1.read_input(6) * 400.0f;
    frequencyParam.attackTauRatio = Adc1.read_input(2) + 0.01f;
    frequencyParam.releaseTauRatio = Adc1.read_input(3) + 0.01f;
}

int main()
{
    printf("%s %s\r\n", TITLE_STR1, TITLE_STR2);

    /*
    SpiM1.format(0, 0);
    SpiM1.frequency(2000000);
    */

    SpiM3.format(8, 0);
    SpiM3.frequency(MCP3008_SPI_SPEED);

    frequency = 100.0f;
    amplitude = 1.0f;
    bpm = 120.0f;
    
    setParams();

    ticks = 0;
    Ticker samplingTicker;
    samplingTicker.attach(&update, (1.0f/ENVELOPE_UPDATE_RATE));

    for (;;) {
#if (PIN_CHECK)
        Dout2 = 1;
#endif
        setParams();
#if (PIN_CHECK)
        Dout2 = 0;
#endif

#if UART_TRACE
        printf("%.1f\t%d\t", bpm, envelopeLength);

        printf("%d\t%d\t", amplitudeParam.attack, amplitudeParam.release);
        printf("%.2f\t%.2f\t%.2f\t", amplitudeParam.v0, amplitudeParam.v1, amplitudeParam.v2);
        printf("%.2f\t%.2f\t", amplitudeParam.attackTauRatio, amplitudeParam.releaseTauRatio);

        printf("%d\t%d\t", frequencyParam.attack, frequencyParam.release);
        printf("%.2f\t%.2f\t%.2f\t", frequencyParam.v0, frequencyParam.v1, frequencyParam.v2);
        printf("%.2f\t%.2f\r\n", frequencyParam.attackTauRatio, frequencyParam.releaseTauRatio);
#endif

        Thread::wait(1);
    }
}