Abel Zatarain / Mbed 2 deprecated FMSynthCSUSM

Dependencies:   mbed

Committer:
davolfman
Date:
Wed Nov 29 02:34:59 2017 +0000
Revision:
4:1d2a699c95c7
Parent:
3:83ac767f3a63
Child:
5:ac5c4bd3ef4b
computed carrier increments

Who changed what in which revision?

UserRevisionLine numberNew contents of line
davolfman 0:b2f7400596ce 1 #include "mbed.h"
davolfman 3:83ac767f3a63 2 #include "sintable.h"
davolfman 0:b2f7400596ce 3
davolfman 0:b2f7400596ce 4 AnalogOut DAC0(PA_4);//Not labeled in the docs for the f401, but seems to be for all
davolfman 0:b2f7400596ce 5 AnalogOut DAC1(PA_5);
davolfman 0:b2f7400596ce 6
davolfman 0:b2f7400596ce 7 AnalogIn ADC0(PA_0);
davolfman 0:b2f7400596ce 8 AnalogIn ADC1(PA_1);
davolfman 0:b2f7400596ce 9 //AnalogIn ADC2(PA_2);//not labeled as such in MBED's docs for f401, yes 446
davolfman 0:b2f7400596ce 10 //AnalogIn ADC3(PA_3);//not labeled as such in MBED's docs for f401, yes 446
davolfman 0:b2f7400596ce 11 //AnalogIn ADC4(PA_4);//we're using these for output
davolfman 0:b2f7400596ce 12 //AnalogIn ADC5(PA_5);//we're using these for output
davolfman 0:b2f7400596ce 13 AnalogIn ADC6(PA_6);
davolfman 0:b2f7400596ce 14 AnalogIn ADC7(PA_7);
davolfman 0:b2f7400596ce 15 //AnalogIn ADC8(PB_0);//lets leave the 2 we aren't using in a single port
davolfman 0:b2f7400596ce 16 //AnalogIn ADC9(PB_1);//that way we know there's not ADCs on one of them
davolfman 0:b2f7400596ce 17 AnalogIn ADC10(PC_0);
davolfman 0:b2f7400596ce 18 AnalogIn ADC11(PC_1);
davolfman 0:b2f7400596ce 19 AnalogIn ADC12(PC_2);
davolfman 0:b2f7400596ce 20 AnalogIn ADC13(PC_3);
davolfman 0:b2f7400596ce 21 AnalogIn ADC14(PC_4);
davolfman 0:b2f7400596ce 22 AnalogIn ADC15(PC_5);
davolfman 0:b2f7400596ce 23
davolfman 2:5454dee210ed 24 BusIn keyBank(PC_10, PC_11, PC_12, PC_13, PC_14, PC_15);
davolfman 2:5454dee210ed 25 BusOut keySelect(PB_0, PB_1, PB_2, PB_3, PB_4, PB_5, PB_6, PB_7, PB_8);
davolfman 2:5454dee210ed 26 BusIn numerator(PA_8, PA_9, PA_10, PA_11);
davolfman 2:5454dee210ed 27 BusIn denominator(PA_12, PA_13, PA_14, PA_15);
davolfman 2:5454dee210ed 28
davolfman 0:b2f7400596ce 29 //Renaming ports
davolfman 0:b2f7400596ce 30 #define inVol ADC0
davolfman 0:b2f7400596ce 31 #define inModAmt ADC1
davolfman 0:b2f7400596ce 32 #define inCarA ADC6
davolfman 0:b2f7400596ce 33 #define inCarD ADC7
davolfman 0:b2f7400596ce 34 #define inCarS ADC10
davolfman 0:b2f7400596ce 35 #define inCarR ADC11
davolfman 0:b2f7400596ce 36 #define inModA ADC12
davolfman 0:b2f7400596ce 37 #define inModD ADC13
davolfman 0:b2f7400596ce 38 #define inModS ADC14
davolfman 0:b2f7400596ce 39 #define inModR ADC15
davolfman 0:b2f7400596ce 40 #define outMono DAC0
davolfman 0:b2f7400596ce 41
davolfman 2:5454dee210ed 42 #define numKeys 49
davolfman 1:f3350a372732 43 #define PI M_PI
davolfman 0:b2f7400596ce 44
davolfman 4:1d2a699c95c7 45 //constants
davolfman 4:1d2a699c95c7 46 const int carrierIncrements[] = {107, 113, 120, 127, 135, 143, 151, 160, 170,
davolfman 4:1d2a699c95c7 47 180, 190, 202, 214, 227, 240, 254, 270, 286, 303, 321, 340, 360, 381, 404,
davolfman 4:1d2a699c95c7 48 428, 454, 481, 509, 540, 572, 606, 642, 680, 720, 763, 809, 857, 908, 962,
davolfman 4:1d2a699c95c7 49 1019, 1080, 1144, 1212, 1284, 1360, 1441, 1527, 1618, 1714};
davolfman 1:f3350a372732 50 const int attackLimit = (0x1 << 16) - 1;
davolfman 1:f3350a372732 51 const int fixed2Pi = (int) ((2.0 * PI) * (0x1 << 16));
davolfman 1:f3350a372732 52
davolfman 0:b2f7400596ce 53 //non-constants
davolfman 1:f3350a372732 54 //Most of these will be recalculated or reset on every input cycle of the main
davolfman 1:f3350a372732 55 // loop, as appropriate
davolfman 0:b2f7400596ce 56 int FMmult;
davolfman 0:b2f7400596ce 57 int Volume;
davolfman 1:f3350a372732 58 int modVol;
davolfman 1:f3350a372732 59 int modAmpI;
davolfman 1:f3350a372732 60 int carAmpS;
davolfman 2:5454dee210ed 61 //bool keysPressed[numKeys];
davolfman 2:5454dee210ed 62 int64_t keyboard;
davolfman 0:b2f7400596ce 63 int carrierPhases[numKeys];
davolfman 0:b2f7400596ce 64 int modulatorPhases[numKeys];
davolfman 0:b2f7400596ce 65 short envelopeStatesC[numKeys];
davolfman 0:b2f7400596ce 66 short envelopeStatesM[numKeys];
davolfman 0:b2f7400596ce 67 int envelopeAmpsC[numKeys];
davolfman 1:f3350a372732 68 int envelopeAmpsM[numKeys];
davolfman 1:f3350a372732 69
davolfman 1:f3350a372732 70 int modA;
davolfman 1:f3350a372732 71 int modD;
davolfman 1:f3350a372732 72 int modS;
davolfman 1:f3350a372732 73 int modR;
davolfman 1:f3350a372732 74 int carA;
davolfman 1:f3350a372732 75 int carD;
davolfman 1:f3350a372732 76 int carS;
davolfman 1:f3350a372732 77 int carR;
davolfman 1:f3350a372732 78
davolfman 1:f3350a372732 79 int fastSin(const int phase){
davolfman 3:83ac767f3a63 80 int i = phase >> 2;
davolfman 3:83ac767f3a63 81 int sum = 0;
davolfman 3:83ac767f3a63 82 sum += (phase & 0x3) * sintable[i+1];
davolfman 3:83ac767f3a63 83 sum += (0x4 - (phase & 0x3)) * sintable[i];
davolfman 3:83ac767f3a63 84 sum = sum >> 2;
davolfman 3:83ac767f3a63 85
davolfman 3:83ac767f3a63 86 return sum;
davolfman 1:f3350a372732 87 }
davolfman 0:b2f7400596ce 88
davolfman 1:f3350a372732 89 void synthesize(){
davolfman 1:f3350a372732 90 carAmpS = 0;
davolfman 1:f3350a372732 91 for(int i = 0; i < numKeys; ++i){
davolfman 2:5454dee210ed 92 if(keyboard & (0x1 << i)){
davolfman 1:f3350a372732 93 if(envelopeStatesC[i] < 2)
davolfman 1:f3350a372732 94 envelopeStatesC[i] = 4;
davolfman 1:f3350a372732 95 if(envelopeStatesM[i] < 2)
davolfman 1:f3350a372732 96 envelopeStatesM[i] = 4;
davolfman 1:f3350a372732 97
davolfman 1:f3350a372732 98 if(envelopeStatesC[i] == 4){
davolfman 1:f3350a372732 99 envelopeAmpsC[i] += carA;
davolfman 1:f3350a372732 100 if(envelopeAmpsC[i] >= attackLimit){
davolfman 1:f3350a372732 101 envelopeAmpsC[i] = attackLimit;
davolfman 1:f3350a372732 102 envelopeStatesC[i] = 3;
davolfman 1:f3350a372732 103 }
davolfman 1:f3350a372732 104 }
davolfman 1:f3350a372732 105
davolfman 1:f3350a372732 106 if(envelopeStatesM[i] == 4){
davolfman 1:f3350a372732 107 envelopeAmpsM[i] += modA;
davolfman 1:f3350a372732 108 if(envelopeAmpsM[i] >= attackLimit){
davolfman 1:f3350a372732 109 envelopeAmpsM[i] = attackLimit;
davolfman 1:f3350a372732 110 envelopeStatesM[i] = 3;
davolfman 1:f3350a372732 111 }
davolfman 1:f3350a372732 112 }
davolfman 1:f3350a372732 113
davolfman 1:f3350a372732 114 if(envelopeStatesC[i] == 3){
davolfman 1:f3350a372732 115 envelopeAmpsC[i] += carD;
davolfman 1:f3350a372732 116 if(envelopeAmpsC[i] <= carS){
davolfman 1:f3350a372732 117 envelopeAmpsC[i] = carS;
davolfman 1:f3350a372732 118 envelopeStatesC[i] = 2;
davolfman 1:f3350a372732 119 }
davolfman 1:f3350a372732 120 }
davolfman 1:f3350a372732 121
davolfman 1:f3350a372732 122 if(envelopeStatesM[i] == 3){
davolfman 1:f3350a372732 123 envelopeAmpsM[i] += modD;
davolfman 1:f3350a372732 124 if(envelopeAmpsM[i] <= modS){
davolfman 1:f3350a372732 125 envelopeAmpsM[i] = modS;
davolfman 1:f3350a372732 126 envelopeStatesM[i] = 2;
davolfman 1:f3350a372732 127 }
davolfman 1:f3350a372732 128 }
davolfman 1:f3350a372732 129 }else{
davolfman 1:f3350a372732 130 if(envelopeStatesC[i] > 1)
davolfman 1:f3350a372732 131 envelopeStatesC[i] = 1;
davolfman 1:f3350a372732 132 if(envelopeStatesM[i] > 1)
davolfman 1:f3350a372732 133 envelopeStatesM[i] = 1;
davolfman 1:f3350a372732 134
davolfman 1:f3350a372732 135 if(envelopeStatesC[i] == 1){
davolfman 1:f3350a372732 136 if(envelopeAmpsC[i] <= 0){
davolfman 1:f3350a372732 137 envelopeStatesC[i] = 0;
davolfman 1:f3350a372732 138 envelopeAmpsC[i] = 0;
davolfman 1:f3350a372732 139 }else{
davolfman 1:f3350a372732 140 envelopeAmpsC[i] -= carR;
davolfman 1:f3350a372732 141 }
davolfman 1:f3350a372732 142 }
davolfman 1:f3350a372732 143 if(envelopeStatesM[i] == 1){
davolfman 1:f3350a372732 144 if(envelopeAmpsM[i] <= 0){
davolfman 1:f3350a372732 145 envelopeStatesM[i] = 0;
davolfman 1:f3350a372732 146 envelopeAmpsM[i] = 0;
davolfman 1:f3350a372732 147 }else{
davolfman 1:f3350a372732 148 envelopeAmpsM[i] -= modR;
davolfman 1:f3350a372732 149 }
davolfman 1:f3350a372732 150 }
davolfman 1:f3350a372732 151 }
davolfman 1:f3350a372732 152
davolfman 1:f3350a372732 153 if(envelopeAmpsC[i] > 0){
davolfman 1:f3350a372732 154 modulatorPhases[i] += (Fmult * carrierIncrements[i]) >> 16;
davolfman 1:f3350a372732 155 modAmpI = fastSin((((modulatorPhases[i] * envelopeAmpsM[i]) >> 16)
davolfman 1:f3350a372732 156 * modVol) >> 16);
davolfman 1:f3350a372732 157 carrierPhases[i] += ((carrierIncrements[i] + modAmpI) * fixed2pi) >> 16;
davolfman 1:f3350a372732 158 carAmps += (fastSin(carrierPhases[i]) * envelopeAmpsC[i]) >> 16;
davolfman 1:f3350a372732 159 }
davolfman 1:f3350a372732 160 }
davolfman 1:f3350a372732 161 outMono.write_u16(((carAmps / numKeys) * Volume) >> 16);
davolfman 1:f3350a372732 162 }
davolfman 0:b2f7400596ce 163
davolfman 0:b2f7400596ce 164
davolfman 0:b2f7400596ce 165 int main() {
davolfman 2:5454dee210ed 166 int ratNumer;
davolfman 2:5454dee210ed 167 int ratDenom;
davolfman 2:5454dee210ed 168
davolfman 2:5454dee210ed 169 while(true){
davolfman 2:5454dee210ed 170 ratNumer = 0xf & ~ numerator;
davolfman 2:5454dee210ed 171 ratDenom = 0xf & ~ denom;
davolfman 2:5454dee210ed 172 FMult = (ratNumer << 16) / ratDenom;
davolfman 2:5454dee210ed 173
davolfman 2:5454dee210ed 174 Volume = (int)inVol.read_u16();
davolfman 2:5454dee210ed 175 modVol = (int)inModAmt.read_u16();
davolfman 2:5454dee210ed 176
davolfman 2:5454dee210ed 177 carA = 0xffff / ((int)inCarA.read_u16());
davolfman 2:5454dee210ed 178 carD = 0xffff / ((int)inCarD.read_u16());
davolfman 2:5454dee210ed 179 carS = (int)inCarS.read_u16();
davolfman 2:5454dee210ed 180 carR = 0xffff / ((int)inCarR.read_u16());
davolfman 2:5454dee210ed 181
davolfman 2:5454dee210ed 182 modA = 0xffff / ((int)inModA.read_u16());
davolfman 2:5454dee210ed 183 modD = 0xffff / ((int)inModD.read_u16());
davolfman 2:5454dee210ed 184 modS = (int)inModS.read_u16();
davolfman 2:5454dee210ed 185 modR = 0xffff / ((int)inModR.read_u16());
davolfman 2:5454dee210ed 186
davolfman 2:5454dee210ed 187
davolfman 2:5454dee210ed 188 }
davolfman 0:b2f7400596ce 189 }