Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
main.cpp@4:1d2a699c95c7, 2017-11-29 (annotated)
- 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?
User | Revision | Line number | New 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 | } |