Ryo Od / Mbed 2 deprecated KIK01_Proto08

KIK01 Proto 08

Dependencies:   AverageMCP3008 VoltageMonitor mbed-rtos mbed mcp3008

Fork of KIK01_Proto07 by Ryo Od

main.cpp@9:d1e6eae9722b, 2017-06-04 (annotated)

Committer:
ryood
Date:
Sun Jun 04 11:39:50 2017 +0000
Revision:
9:d1e6eae9722b
Parent:
8:bb34a4894337
Child:
10:79134dbb339d
Impl. TauRatio

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ryood 3:f89b400cfe57 1 /*
ryood 3:f89b400cfe57 2 * KIK01
ryood 3:f89b400cfe57 3 * Kick Machine
ryood 3:f89b400cfe57 4 *
ryood 3:f89b400cfe57 5 * 2017.06.04 created.
ryood 3:f89b400cfe57 6 *
ryood 3:f89b400cfe57 7 */
ryood 3:f89b400cfe57 8
ryood 0:2dcec10e9199 9 #include "mbed.h"
ryood 0:2dcec10e9199 10 #include "rtos.h"
ryood 0:2dcec10e9199 11
ryood 0:2dcec10e9199 12 #define TITLE_STR1 ("KIK01 Kick Machine")
ryood 0:2dcec10e9199 13 #define TITLE_STR2 ("20170604")
ryood 0:2dcec10e9199 14
ryood 0:2dcec10e9199 15 #define PI_F (3.1415926f)
ryood 9:d1e6eae9722b 16 #define SAMPLING_RATE (96000)
ryood 0:2dcec10e9199 17 #define SAMPLING_PERIOD (1.0f/SAMPLING_RATE)
ryood 0:2dcec10e9199 18
ryood 3:f89b400cfe57 19 AnalogOut Dac1(PA_5);
ryood 3:f89b400cfe57 20
ryood 5:846772a77d33 21 AnalogIn Ain0(PA_0);
ryood 5:846772a77d33 22 AnalogIn Ain1(PA_1);
ryood 5:846772a77d33 23 AnalogIn Ain2(PA_4);
ryood 5:846772a77d33 24 AnalogIn Ain3(PB_0);
ryood 5:846772a77d33 25 AnalogIn Ain4(PC_1);
ryood 5:846772a77d33 26 AnalogIn Ain5(PC_0);
ryood 5:846772a77d33 27 AnalogIn Ain6(PC_2);
ryood 5:846772a77d33 28 AnalogIn Ain7(PC_3);
ryood 0:2dcec10e9199 29
ryood 8:bb34a4894337 30 AnalogIn Ain8(PC_4);
ryood 8:bb34a4894337 31 AnalogIn Ain9(PB_1);
ryood 8:bb34a4894337 32 AnalogIn Ain10(PC_5);
ryood 8:bb34a4894337 33
ryood 0:2dcec10e9199 34 class EnvelopeAR {
ryood 0:2dcec10e9199 35 public:
ryood 0:2dcec10e9199 36 EnvelopeAR(int _attack, int _release, float _v0, float _v1, float _v2, float _attackTauRatio=0.36f, float _releaseTauRatio=0.36f) :
ryood 0:2dcec10e9199 37 amplitude(_v0),
ryood 0:2dcec10e9199 38 v0(_v0),
ryood 0:2dcec10e9199 39 v1(_v1),
ryood 0:2dcec10e9199 40 v2(_v2),
ryood 0:2dcec10e9199 41 vLast(_v0),
ryood 0:2dcec10e9199 42 attackTauRatio(_attackTauRatio),
ryood 0:2dcec10e9199 43 releaseTauRatio(_releaseTauRatio)
ryood 0:2dcec10e9199 44 {
ryood 0:2dcec10e9199 45 setAttack(_attack);
ryood 0:2dcec10e9199 46 setRelease(_release);
ryood 0:2dcec10e9199 47 }
ryood 0:2dcec10e9199 48
ryood 0:2dcec10e9199 49 ~EnvelopeAR() {}
ryood 0:2dcec10e9199 50
ryood 0:2dcec10e9199 51 void setAttack(int _attack) {
ryood 0:2dcec10e9199 52 attack = _attack;
ryood 0:2dcec10e9199 53 tau0 = attack * attackTauRatio;
ryood 0:2dcec10e9199 54 }
ryood 0:2dcec10e9199 55 int getAttack() { return attack; }
ryood 0:2dcec10e9199 56
ryood 0:2dcec10e9199 57 void setRelease(int _release) {
ryood 0:2dcec10e9199 58 release = _release;
ryood 0:2dcec10e9199 59 tau1 = release * releaseTauRatio;
ryood 0:2dcec10e9199 60 }
ryood 0:2dcec10e9199 61 int getRelease() { return release; }
ryood 0:2dcec10e9199 62
ryood 5:846772a77d33 63 void setAttackTauRatio(float _attackTauRatio) {
ryood 5:846772a77d33 64 attackTauRatio = _attackTauRatio;
ryood 5:846772a77d33 65 tau0 = attack * attackTauRatio;
ryood 5:846772a77d33 66 }
ryood 0:2dcec10e9199 67 float getAttackTauRatio() { return attackTauRatio; }
ryood 0:2dcec10e9199 68
ryood 5:846772a77d33 69 void setReleaseTauRatio(float _releaseTauRatio) {
ryood 5:846772a77d33 70 releaseTauRatio = _releaseTauRatio;
ryood 5:846772a77d33 71 tau1 = release * releaseTauRatio;
ryood 5:846772a77d33 72 }
ryood 0:2dcec10e9199 73 float getReleaseTauRatio() { return releaseTauRatio; }
ryood 5:846772a77d33 74
ryood 5:846772a77d33 75 float getTau0() { return tau0; }
ryood 5:846772a77d33 76 float getTau1() { return tau1; }
ryood 0:2dcec10e9199 77
ryood 0:2dcec10e9199 78 void setV0(float _v0) { v0 = _v0; }
ryood 0:2dcec10e9199 79 float getV0() { return v0; }
ryood 0:2dcec10e9199 80 void setV1(float _v1) { v1 = _v1; }
ryood 0:2dcec10e9199 81 float getV1() { return v1; }
ryood 0:2dcec10e9199 82 void setV2(float _v2) { v2 = _v2; }
ryood 0:2dcec10e9199 83 float getV2() { return v2; }
ryood 0:2dcec10e9199 84
ryood 0:2dcec10e9199 85 float getAmplitude() { return amplitude; }
ryood 0:2dcec10e9199 86 float getAmplitude(int tick) {
ryood 0:2dcec10e9199 87 if (tick < attack) {
ryood 0:2dcec10e9199 88 // attackの処理
ryood 0:2dcec10e9199 89 amplitude = v0 + (v1 - v0) * (1 - expf(-(float)tick / tau0));
ryood 0:2dcec10e9199 90 vLast = amplitude;
ryood 0:2dcec10e9199 91 }
ryood 0:2dcec10e9199 92 else {
ryood 0:2dcec10e9199 93 // releaseの処理
ryood 0:2dcec10e9199 94 amplitude = (vLast - v2) * (expf(-(float)(tick - attack) / tau1)) + v2;
ryood 0:2dcec10e9199 95 }
ryood 0:2dcec10e9199 96 return amplitude;
ryood 0:2dcec10e9199 97 }
ryood 0:2dcec10e9199 98
ryood 0:2dcec10e9199 99 private:
ryood 0:2dcec10e9199 100 int attack;
ryood 0:2dcec10e9199 101 int release;
ryood 0:2dcec10e9199 102 float amplitude;
ryood 0:2dcec10e9199 103 float v0;
ryood 0:2dcec10e9199 104 float v1;
ryood 0:2dcec10e9199 105 float v2;
ryood 0:2dcec10e9199 106 float vLast;
ryood 0:2dcec10e9199 107 float tau0;
ryood 0:2dcec10e9199 108 float tau1;
ryood 0:2dcec10e9199 109 float attackTauRatio;
ryood 0:2dcec10e9199 110 float releaseTauRatio;
ryood 0:2dcec10e9199 111 };
ryood 0:2dcec10e9199 112
ryood 5:846772a77d33 113 class EnvelopeParam {
ryood 5:846772a77d33 114 public:
ryood 5:846772a77d33 115 int attack;
ryood 5:846772a77d33 116 int release;
ryood 5:846772a77d33 117 float v0;
ryood 5:846772a77d33 118 float v1;
ryood 5:846772a77d33 119 float v2;
ryood 5:846772a77d33 120 float attackTauRatio;
ryood 5:846772a77d33 121 float releaseTauRatio;
ryood 5:846772a77d33 122 };
ryood 5:846772a77d33 123
ryood 9:d1e6eae9722b 124 EnvelopeAR envelopeFrequency(5, 300, 880.0f, 120.0f, 40.0f, 0.36f, 0.1f);
ryood 5:846772a77d33 125 EnvelopeAR envelopeAmplitude(50, 200, 0.99f, 1.0f, 0.0f);
ryood 5:846772a77d33 126
ryood 5:846772a77d33 127 volatile EnvelopeParam frequencyParam;
ryood 5:846772a77d33 128 volatile EnvelopeParam amplitudeParam;
ryood 0:2dcec10e9199 129
ryood 3:f89b400cfe57 130 volatile int ticks;
ryood 3:f89b400cfe57 131 volatile int envelopeTicks;
ryood 3:f89b400cfe57 132 volatile float frequency;
ryood 3:f89b400cfe57 133 volatile float phi;
ryood 3:f89b400cfe57 134 volatile float phiDelta;
ryood 3:f89b400cfe57 135 volatile float amplitude;
ryood 3:f89b400cfe57 136
ryood 5:846772a77d33 137 volatile float bpm;
ryood 5:846772a77d33 138 volatile int envelopeLength;
ryood 0:2dcec10e9199 139
ryood 0:2dcec10e9199 140 void generateWave()
ryood 0:2dcec10e9199 141 {
ryood 0:2dcec10e9199 142 phi += phiDelta;
ryood 0:2dcec10e9199 143 if (phi >= 1.0f) {
ryood 0:2dcec10e9199 144 phi -= 2.0f;
ryood 0:2dcec10e9199 145 }
ryood 0:2dcec10e9199 146 float level = sinf(PI_F * phi) * amplitude;
ryood 1:f9b967ae26e4 147
ryood 3:f89b400cfe57 148 Dac1.write((level * 0.7f + 1.0f) / 2.0f);
ryood 0:2dcec10e9199 149 }
ryood 0:2dcec10e9199 150
ryood 0:2dcec10e9199 151 void generateEnvelope()
ryood 0:2dcec10e9199 152 {
ryood 0:2dcec10e9199 153 // Frequency Envelope
ryood 0:2dcec10e9199 154 frequency = envelopeFrequency.getAmplitude(envelopeTicks);
ryood 0:2dcec10e9199 155 phiDelta = 2.0f * frequency / SAMPLING_RATE;
ryood 0:2dcec10e9199 156
ryood 0:2dcec10e9199 157 // Amplitude Envelope
ryood 0:2dcec10e9199 158 amplitude = envelopeAmplitude.getAmplitude(envelopeTicks);
ryood 0:2dcec10e9199 159
ryood 0:2dcec10e9199 160 envelopeTicks++;
ryood 7:6735a343780e 161 if (envelopeTicks >= envelopeLength) {
ryood 0:2dcec10e9199 162 envelopeTicks = 0;
ryood 0:2dcec10e9199 163 }
ryood 0:2dcec10e9199 164 }
ryood 0:2dcec10e9199 165
ryood 2:8dff77a1ee4d 166 void update()
ryood 2:8dff77a1ee4d 167 {
ryood 3:f89b400cfe57 168 ticks++;
ryood 7:6735a343780e 169 if (ticks >= SAMPLING_RATE / 1000) {
ryood 3:f89b400cfe57 170 ticks = 0;
ryood 5:846772a77d33 171
ryood 5:846772a77d33 172 // set envelope parameters
ryood 5:846772a77d33 173 envelopeLength = 60 * 1000 / bpm;
ryood 5:846772a77d33 174
ryood 5:846772a77d33 175 envelopeAmplitude.setAttack(amplitudeParam.attack);
ryood 5:846772a77d33 176 envelopeAmplitude.setRelease(amplitudeParam.release);
ryood 5:846772a77d33 177 envelopeAmplitude.setV0(amplitudeParam.v0);
ryood 5:846772a77d33 178 envelopeAmplitude.setV1(amplitudeParam.v1);
ryood 5:846772a77d33 179 envelopeAmplitude.setV2(amplitudeParam.v2);
ryood 5:846772a77d33 180 envelopeAmplitude.setAttackTauRatio(amplitudeParam.attackTauRatio);
ryood 5:846772a77d33 181 envelopeAmplitude.setReleaseTauRatio(amplitudeParam.releaseTauRatio);
ryood 5:846772a77d33 182
ryood 6:897d6392b408 183 envelopeFrequency.setAttack(frequencyParam.attack);
ryood 6:897d6392b408 184 envelopeFrequency.setRelease(frequencyParam.release);
ryood 5:846772a77d33 185 envelopeFrequency.setV0(frequencyParam.v0);
ryood 6:897d6392b408 186 envelopeFrequency.setV1(frequencyParam.v1);
ryood 6:897d6392b408 187 envelopeFrequency.setV2(frequencyParam.v2);
ryood 6:897d6392b408 188 envelopeFrequency.setAttackTauRatio(frequencyParam.attackTauRatio);
ryood 6:897d6392b408 189 envelopeFrequency.setReleaseTauRatio(frequencyParam.releaseTauRatio);
ryood 5:846772a77d33 190
ryood 2:8dff77a1ee4d 191 generateEnvelope();
ryood 2:8dff77a1ee4d 192 }
ryood 2:8dff77a1ee4d 193 generateWave();
ryood 2:8dff77a1ee4d 194 }
ryood 2:8dff77a1ee4d 195
ryood 5:846772a77d33 196 void setParams()
ryood 5:846772a77d33 197 {
ryood 5:846772a77d33 198 bpm = Ain0.read() * 180.0f + 60.0f;
ryood 5:846772a77d33 199
ryood 5:846772a77d33 200 amplitudeParam.attack = Ain1.read() * envelopeLength;
ryood 5:846772a77d33 201 amplitudeParam.release = Ain2.read() * envelopeLength;
ryood 5:846772a77d33 202 amplitudeParam.v0 = Ain3.read();
ryood 5:846772a77d33 203 amplitudeParam.v1 = 1.0f;
ryood 5:846772a77d33 204 amplitudeParam.v2 = 0.0f;
ryood 5:846772a77d33 205 amplitudeParam.attackTauRatio = 0.36f;
ryood 9:d1e6eae9722b 206 amplitudeParam.releaseTauRatio = Ain4.read() + 0.01f;
ryood 5:846772a77d33 207
ryood 9:d1e6eae9722b 208 frequencyParam.attack = Ain8.read() * envelopeLength * 0.1f;
ryood 6:897d6392b408 209 frequencyParam.release = 300;
ryood 6:897d6392b408 210 frequencyParam.v0 = Ain5.read() * 4000.0f;
ryood 6:897d6392b408 211 frequencyParam.v1 = Ain6.read() * 400.0f;
ryood 6:897d6392b408 212 frequencyParam.v2 = Ain7.read() * 400.0f;
ryood 9:d1e6eae9722b 213 frequencyParam.attackTauRatio = Ain9.read() + 0.01f;
ryood 9:d1e6eae9722b 214 frequencyParam.releaseTauRatio = Ain10.read() + 0.01f;
ryood 5:846772a77d33 215 }
ryood 5:846772a77d33 216
ryood 0:2dcec10e9199 217 int main()
ryood 0:2dcec10e9199 218 {
ryood 0:2dcec10e9199 219 printf("%s %s\r\n", TITLE_STR1, TITLE_STR2);
ryood 0:2dcec10e9199 220
ryood 0:2dcec10e9199 221 frequency = 1000.0f;
ryood 0:2dcec10e9199 222 phiDelta = 2.0f * frequency / SAMPLING_RATE;
ryood 0:2dcec10e9199 223 amplitude = 1.0f;
ryood 0:2dcec10e9199 224
ryood 3:f89b400cfe57 225 ticks = 0;
ryood 2:8dff77a1ee4d 226 envelopeTicks = 0;
ryood 1:f9b967ae26e4 227
ryood 5:846772a77d33 228 bpm = 120.0f;
ryood 5:846772a77d33 229 setParams();
ryood 5:846772a77d33 230
ryood 2:8dff77a1ee4d 231 Ticker samplingTicker;
ryood 2:8dff77a1ee4d 232 samplingTicker.attach(&update, SAMPLING_PERIOD);
ryood 2:8dff77a1ee4d 233
ryood 3:f89b400cfe57 234 for (;;) {
ryood 5:846772a77d33 235 setParams();
ryood 6:897d6392b408 236 printf("%.1f\t%d\t", bpm, envelopeLength);
ryood 6:897d6392b408 237
ryood 6:897d6392b408 238 printf("%d\t%d\t", amplitudeParam.attack, amplitudeParam.release);
ryood 6:897d6392b408 239 printf("%.2f\t%.2f\t%.2f\t", amplitudeParam.v0, amplitudeParam.v1, amplitudeParam.v2);
ryood 6:897d6392b408 240 printf("%.2f\t%.2f\t", amplitudeParam.attackTauRatio, amplitudeParam.releaseTauRatio);
ryood 6:897d6392b408 241
ryood 6:897d6392b408 242 printf("%d\t%d\t", frequencyParam.attack, frequencyParam.release);
ryood 6:897d6392b408 243 printf("%.2f\t%.2f\t%.2f\t", frequencyParam.v0, frequencyParam.v1, frequencyParam.v2);
ryood 6:897d6392b408 244 printf("%.2f\t%.2f\r\n", frequencyParam.attackTauRatio, frequencyParam.releaseTauRatio);
ryood 6:897d6392b408 245
ryood 9:d1e6eae9722b 246 Thread::wait(100);
ryood 3:f89b400cfe57 247 }
ryood 0:2dcec10e9199 248 }