Fengrui Chenchen Zuo / Mbed 2 deprecated 3872_play_live

3872 Play-live--test code - tempting to make this the main one

Dependencies:   mbed fastlib

main.cpp@2:9296823ea33d, 2020-11-11 (annotated)

Committer:
chenchen2020
Date:
Wed Nov 11 04:50:30 2020 +0000
Revision:
2:9296823ea33d
Parent:
1:c704bea518d8 
Final;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
4180_1 0:e09703934ff4 1 #include <mbed.h>
4180_1 0:e09703934ff4 2 #include <string>
4180_1 0:e09703934ff4 3 #include <list>
4180_1 0:e09703934ff4 4
4180_1 0:e09703934ff4 5 #include <mpr121.h>
chenchen2020 1:c704bea518d8 6 #include "SongPlayer.h"
chenchen2020 2:9296823ea33d 7 #include "fastlib/clock.h"
4180_1 0:e09703934ff4 8
chenchen2020 2:9296823ea33d 9 SongPlayer mySpeaker(p21);
chenchen2020 2:9296823ea33d 10
chenchen2020 2:9296823ea33d 11 //fl_select_pll0_clock_source(1);
chenchen2020 2:9296823ea33d 12 //fl_pll0_control(1,1); //enable PLL clock
chenchen2020 2:9296823ea33d 13 //fl_pll0_config(1, 512); //Configure output clock freq.
chenchen2020 2:9296823ea33d 14
chenchen2020 2:9296823ea33d 15 Timer t;
chenchen2020 2:9296823ea33d 16 Timer t_rest;
chenchen2020 2:9296823ea33d 17 Timer t_base;
chenchen2020 2:9296823ea33d 18 Timer reset_timer;
chenchen2020 2:9296823ea33d 19 Timer song_timer;
chenchen2020 2:9296823ea33d 20 bool timer_begin = 0;
chenchen2020 2:9296823ea33d 21 bool played = 0;
chenchen2020 2:9296823ea33d 22 uint16_t value = 0;
chenchen2020 2:9296823ea33d 23 float temp_value;
chenchen2020 2:9296823ea33d 24 PwmOut jawServo(p26);
chenchen2020 2:9296823ea33d 25 PwmOut baseServo(p25);
chenchen2020 1:c704bea518d8 26 DigitalIn record_mode(p14);
chenchen2020 1:c704bea518d8 27 DigitalIn play_back_mode(p16);
chenchen2020 1:c704bea518d8 28 DigitalIn play_live_mode(p15);
chenchen2020 2:9296823ea33d 29 DigitalIn stop_mode(p17);
chenchen2020 2:9296823ea33d 30 DigitalIn reset_mode(p20);
chenchen2020 2:9296823ea33d 31 DigitalOut greenLED(p23);
chenchen2020 2:9296823ea33d 32 DigitalOut redLED(p18);
chenchen2020 2:9296823ea33d 33 DigitalOut blueLED(p22);
chenchen2020 2:9296823ea33d 34
chenchen2020 1:c704bea518d8 35
chenchen2020 2:9296823ea33d 36 enum Statetype {IDLE = 0, REC = 1, PLAY_BACK = 2, PLAY_LIVE = 3, STOP = 4, RESET = 5};
chenchen2020 2:9296823ea33d 37
chenchen2020 2:9296823ea33d 38 Statetype mode;
chenchen2020 2:9296823ea33d 39
chenchen2020 2:9296823ea33d 40 float mem_note[160];
chenchen2020 2:9296823ea33d 41 float mem_duration[160];
chenchen2020 2:9296823ea33d 42 int mem_ind;
chenchen2020 2:9296823ea33d 43 float dt;
chenchen2020 2:9296823ea33d 44 float dur[1]= {0.5f};
chenchen2020 1:c704bea518d8 45
chenchen2020 2:9296823ea33d 46 class Watchdog
chenchen2020 2:9296823ea33d 47 {
chenchen2020 2:9296823ea33d 48 public:
chenchen2020 2:9296823ea33d 49 // Load timeout value in watchdog timer and enable
chenchen2020 2:9296823ea33d 50 void kick(float s)
chenchen2020 2:9296823ea33d 51 {
chenchen2020 2:9296823ea33d 52 LPC_WDT->WDCLKSEL = 0x1; // Set CLK src to PCLK
chenchen2020 2:9296823ea33d 53 uint32_t clk = SystemCoreClock / 16; // WD has a fixed /4 prescaler, PCLK default is /4
chenchen2020 2:9296823ea33d 54 LPC_WDT->WDTC = s * (float)clk;
chenchen2020 2:9296823ea33d 55 LPC_WDT->WDMOD = 0x3; // Enabled and Reset
chenchen2020 2:9296823ea33d 56 kick();
chenchen2020 2:9296823ea33d 57 }
chenchen2020 2:9296823ea33d 58 // "kick" or "feed" the dog - reset the watchdog timer
chenchen2020 2:9296823ea33d 59 // by writing this required bit pattern
chenchen2020 2:9296823ea33d 60 void kick()
chenchen2020 2:9296823ea33d 61 {
chenchen2020 2:9296823ea33d 62 LPC_WDT->WDFEED = 0xAA;
chenchen2020 2:9296823ea33d 63 LPC_WDT->WDFEED = 0x55;
chenchen2020 2:9296823ea33d 64 }
chenchen2020 2:9296823ea33d 65 };
chenchen2020 1:c704bea518d8 66
chenchen2020 2:9296823ea33d 67 Watchdog wdt;
4180_1 0:e09703934ff4 68
4180_1 0:e09703934ff4 69 // Create the interrupt receiver object on pin 26
chenchen2020 2:9296823ea33d 70 InterruptIn interrupt(p30);
4180_1 0:e09703934ff4 71
4180_1 0:e09703934ff4 72 // Setup the Serial to the PC for debugging
4180_1 0:e09703934ff4 73 Serial pc(USBTX, USBRX);
4180_1 0:e09703934ff4 74
4180_1 0:e09703934ff4 75 // Setup the i2c bus on pins 28 and 27
4180_1 0:e09703934ff4 76 I2C i2c(p9, p10);
4180_1 0:e09703934ff4 77
4180_1 0:e09703934ff4 78 // Setup the Mpr121:
4180_1 0:e09703934ff4 79 // constructor(i2c object, i2c address of the mpr121)
4180_1 0:e09703934ff4 80 Mpr121 mpr121(&i2c, Mpr121::ADD_VSS);
4180_1 0:e09703934ff4 81
chenchen2020 2:9296823ea33d 82 float note = 0;
chenchen2020 2:9296823ea33d 83
chenchen2020 2:9296823ea33d 84 float parse_key(uint16_t input)
chenchen2020 2:9296823ea33d 85 {
chenchen2020 2:9296823ea33d 86 switch(input) {
chenchen2020 2:9296823ea33d 87 case 0x0:
chenchen2020 2:9296823ea33d 88 return 0.0;
chenchen2020 2:9296823ea33d 89 case 0x1:
chenchen2020 2:9296823ea33d 90 return 440.0;
chenchen2020 2:9296823ea33d 91 case 0x2:
chenchen2020 2:9296823ea33d 92 return 446.16;
chenchen2020 2:9296823ea33d 93 case 0x4:
chenchen2020 2:9296823ea33d 94 return 493.88;
chenchen2020 2:9296823ea33d 95 case 0x8:
chenchen2020 2:9296823ea33d 96 return 523.25;
chenchen2020 2:9296823ea33d 97 case 0x10:
chenchen2020 2:9296823ea33d 98 return 554.37;
chenchen2020 2:9296823ea33d 99 case 0x20:
chenchen2020 2:9296823ea33d 100 return 587.33;
chenchen2020 2:9296823ea33d 101 case 0x40:
chenchen2020 2:9296823ea33d 102 return 622.25;
chenchen2020 2:9296823ea33d 103 case 0x80:
chenchen2020 2:9296823ea33d 104 return 659.25;
chenchen2020 2:9296823ea33d 105 case 0x100:
chenchen2020 2:9296823ea33d 106 return 698.46;
chenchen2020 2:9296823ea33d 107 case 0x200:
chenchen2020 2:9296823ea33d 108 return 739.99;
chenchen2020 2:9296823ea33d 109 case 0x400:
chenchen2020 2:9296823ea33d 110 return 783.99;
chenchen2020 2:9296823ea33d 111 case 0x800:
chenchen2020 2:9296823ea33d 112 return 830.61;
chenchen2020 2:9296823ea33d 113 default:
chenchen2020 2:9296823ea33d 114 return 0.0;
chenchen2020 2:9296823ea33d 115 }
chenchen2020 2:9296823ea33d 116 }
chenchen2020 2:9296823ea33d 117
chenchen2020 2:9296823ea33d 118 void dance(uint16_t note_input)
chenchen2020 2:9296823ea33d 119 {
chenchen2020 2:9296823ea33d 120
chenchen2020 2:9296823ea33d 121 if(note_input == 0x1) {
chenchen2020 2:9296823ea33d 122 redLED = 1;
chenchen2020 2:9296823ea33d 123 greenLED = 0;
chenchen2020 2:9296823ea33d 124 blueLED = 0;
chenchen2020 2:9296823ea33d 125 jawServo.write(0.11f);
chenchen2020 2:9296823ea33d 126 baseServo.write(0.11f);
chenchen2020 2:9296823ea33d 127 } else if(note_input == 0x1) {
chenchen2020 2:9296823ea33d 128 redLED = 1;
chenchen2020 2:9296823ea33d 129 greenLED = 1;
chenchen2020 2:9296823ea33d 130 blueLED = 0;
chenchen2020 2:9296823ea33d 131 jawServo.write(0.18f);
chenchen2020 2:9296823ea33d 132 baseServo.write(0.18f);
chenchen2020 2:9296823ea33d 133 } else if(note_input == 0x2) {
chenchen2020 2:9296823ea33d 134 redLED = 1;
chenchen2020 2:9296823ea33d 135 greenLED = 1;
chenchen2020 2:9296823ea33d 136 blueLED = 1;
chenchen2020 2:9296823ea33d 137 jawServo.write(0.23f);
chenchen2020 2:9296823ea33d 138 baseServo.write(0.23f);
chenchen2020 2:9296823ea33d 139 } else if(note_input == 0x4) {
chenchen2020 2:9296823ea33d 140 redLED = 0;
chenchen2020 2:9296823ea33d 141 greenLED = 1;
chenchen2020 2:9296823ea33d 142 blueLED = 1;
chenchen2020 2:9296823ea33d 143 jawServo.write(0.28f);
chenchen2020 2:9296823ea33d 144 baseServo.write(0.28f);
chenchen2020 2:9296823ea33d 145 } else if(note_input == 0x8) {
chenchen2020 2:9296823ea33d 146 redLED = 0;
chenchen2020 2:9296823ea33d 147 greenLED = 0;
chenchen2020 2:9296823ea33d 148 blueLED = 1;
chenchen2020 2:9296823ea33d 149 jawServo.write(0.34f);
chenchen2020 2:9296823ea33d 150 baseServo.write(0.34f);
chenchen2020 2:9296823ea33d 151 } else if(note_input == 0x10) {
chenchen2020 2:9296823ea33d 152 redLED = 0;
chenchen2020 2:9296823ea33d 153 greenLED = 1;
chenchen2020 2:9296823ea33d 154 blueLED = 1;
chenchen2020 2:9296823ea33d 155 jawServo.write(0.39f);
chenchen2020 2:9296823ea33d 156 baseServo.write(0.39f);
chenchen2020 2:9296823ea33d 157 } else if(note_input == 0x20) {
chenchen2020 2:9296823ea33d 158 redLED = 1;
chenchen2020 2:9296823ea33d 159 greenLED = 0;
chenchen2020 2:9296823ea33d 160 blueLED = 1;
chenchen2020 2:9296823ea33d 161 jawServo.write(0.48f);
chenchen2020 2:9296823ea33d 162 baseServo.write(0.48f);
chenchen2020 2:9296823ea33d 163 } else if(note_input == 0x40) {
chenchen2020 2:9296823ea33d 164 redLED = 1;
chenchen2020 2:9296823ea33d 165 greenLED = 1;
chenchen2020 2:9296823ea33d 166 blueLED = 0;
chenchen2020 2:9296823ea33d 167 jawServo.write(0.55f);
chenchen2020 2:9296823ea33d 168 baseServo.write(0.55f);
chenchen2020 2:9296823ea33d 169 } else if(note_input == 0x80) {
chenchen2020 2:9296823ea33d 170 redLED = 0;
chenchen2020 2:9296823ea33d 171 greenLED = 1;
chenchen2020 2:9296823ea33d 172 blueLED = 1;
chenchen2020 2:9296823ea33d 173 jawServo.write(0.63f);
chenchen2020 2:9296823ea33d 174 baseServo.write(0.63f);
chenchen2020 2:9296823ea33d 175 } else if(note_input == 0x100) {
chenchen2020 2:9296823ea33d 176 redLED = 1;
chenchen2020 2:9296823ea33d 177 greenLED = 1;
chenchen2020 2:9296823ea33d 178 blueLED = 0;
chenchen2020 2:9296823ea33d 179 jawServo.write(0.73f);
chenchen2020 2:9296823ea33d 180 baseServo.write(0.73f);
chenchen2020 2:9296823ea33d 181 } else if(note_input == 0x200) {
chenchen2020 2:9296823ea33d 182 redLED = 1;
chenchen2020 2:9296823ea33d 183 greenLED = 0;
chenchen2020 2:9296823ea33d 184 blueLED = 1;
chenchen2020 2:9296823ea33d 185 jawServo.write(0.83f);
chenchen2020 2:9296823ea33d 186 baseServo.write(0.83f);
chenchen2020 2:9296823ea33d 187 } else if(note_input == 0x400) {
chenchen2020 2:9296823ea33d 188 redLED = 1;
chenchen2020 2:9296823ea33d 189 greenLED = 0;
chenchen2020 2:9296823ea33d 190 blueLED = 1;
chenchen2020 2:9296823ea33d 191 jawServo.write(0.88f);
chenchen2020 2:9296823ea33d 192 baseServo.write(0.88f);
chenchen2020 2:9296823ea33d 193 } else if(note_input == 0x800) {
chenchen2020 2:9296823ea33d 194 redLED = 1;
chenchen2020 2:9296823ea33d 195 greenLED = 1;
chenchen2020 2:9296823ea33d 196 blueLED = 1;
chenchen2020 2:9296823ea33d 197 jawServo.write(0.93f);
chenchen2020 2:9296823ea33d 198 baseServo.write(0.93f);
chenchen2020 2:9296823ea33d 199 } else {
chenchen2020 2:9296823ea33d 200 redLED = 1;
chenchen2020 2:9296823ea33d 201 greenLED = 1;
chenchen2020 2:9296823ea33d 202 blueLED = 1;
chenchen2020 2:9296823ea33d 203 jawServo.write(0.98f);
chenchen2020 2:9296823ea33d 204 baseServo.write(0.98f);
chenchen2020 2:9296823ea33d 205 }
chenchen2020 2:9296823ea33d 206 //wait(0.45);
chenchen2020 2:9296823ea33d 207 }
chenchen2020 2:9296823ea33d 208
chenchen2020 2:9296823ea33d 209 void fallInterrupt()
chenchen2020 2:9296823ea33d 210 {
chenchen2020 1:c704bea518d8 211 //int key_code=0;
chenchen2020 1:c704bea518d8 212 //int i=0;
chenchen2020 2:9296823ea33d 213 //wdt.kick();
chenchen2020 2:9296823ea33d 214 interrupt.fall(NULL);
chenchen2020 2:9296823ea33d 215 t_rest.stop();
chenchen2020 2:9296823ea33d 216 t.start();
chenchen2020 1:c704bea518d8 217 uint16_t value=mpr121.read(0x00);
4180_1 0:e09703934ff4 218 value +=mpr121.read(0x01)<<8;
chenchen2020 2:9296823ea33d 219 float temp_value = parse_key(value);
chenchen2020 2:9296823ea33d 220 if(record_mode == 0 && mem_ind < 160){
chenchen2020 1:c704bea518d8 221 //Write duration and silence in object
chenchen2020 1:c704bea518d8 222 mem_note[mem_ind] = 0;
chenchen2020 1:c704bea518d8 223 mem_duration[mem_ind] = t_rest.read();
chenchen2020 1:c704bea518d8 224 pc.printf("New Data in memory: Note: %f Duration: %f\n", mem_note[mem_ind], mem_duration[mem_ind]);
chenchen2020 1:c704bea518d8 225 mem_ind++;
chenchen2020 1:c704bea518d8 226 }
chenchen2020 1:c704bea518d8 227 pc.printf("The time of silence seconds %f \n", t_rest.read());
chenchen2020 1:c704bea518d8 228 t_rest.reset();
chenchen2020 2:9296823ea33d 229 wait(0.1);
chenchen2020 2:9296823ea33d 230 float note = parse_key(value);
chenchen2020 2:9296823ea33d 231 if(play_live_mode == 0 || record_mode == 0){
chenchen2020 1:c704bea518d8 232 mySpeaker.Play_Note(note);
chenchen2020 2:9296823ea33d 233 dance(note);
chenchen2020 1:c704bea518d8 234 }
chenchen2020 2:9296823ea33d 235 //wdt.kick();
chenchen2020 1:c704bea518d8 236 //sustaining note
chenchen2020 1:c704bea518d8 237 while(value > 0){
chenchen2020 2:9296823ea33d 238 if(play_live_mode == 0 || record_mode == 0){
chenchen2020 1:c704bea518d8 239 mySpeaker.Play_Note(note);
4180_1 0:e09703934ff4 240 }
chenchen2020 2:9296823ea33d 241 wait(0.05);
chenchen2020 1:c704bea518d8 242 pc.printf("MPR value: %x \r\n", value);
chenchen2020 2:9296823ea33d 243 note = parse_key(value);
chenchen2020 2:9296823ea33d 244 if(play_live_mode == 0 || record_mode == 0){
chenchen2020 1:c704bea518d8 245 mySpeaker.Play_Note(note);
chenchen2020 1:c704bea518d8 246 }
chenchen2020 1:c704bea518d8 247 value=mpr121.read(0x00);
chenchen2020 1:c704bea518d8 248 value +=mpr121.read(0x01)<<8;
chenchen2020 2:9296823ea33d 249 //wdt.kick();
chenchen2020 1:c704bea518d8 250 }
chenchen2020 1:c704bea518d8 251 mySpeaker.Play_Note(0);
chenchen2020 1:c704bea518d8 252 t.stop();
chenchen2020 2:9296823ea33d 253 if(record_mode == 0 && mem_ind < 160){
chenchen2020 1:c704bea518d8 254 mem_note[mem_ind] = temp_value;
chenchen2020 1:c704bea518d8 255 mem_duration[mem_ind] = t.read();
chenchen2020 1:c704bea518d8 256 pc.printf("New Data in memory: Note: %f Duration: %f\n", mem_note[mem_ind], mem_duration[mem_ind]);
chenchen2020 1:c704bea518d8 257 mem_ind++;
chenchen2020 1:c704bea518d8 258 }
chenchen2020 1:c704bea518d8 259 t_rest.start();
chenchen2020 1:c704bea518d8 260 float duration[] = {t.read()};
chenchen2020 1:c704bea518d8 261 pc.printf("The of note seconds %f \n", t.read());
chenchen2020 1:c704bea518d8 262 t.reset();
chenchen2020 2:9296823ea33d 263 //wait(0.05);
chenchen2020 2:9296823ea33d 264 interrupt.fall(&fallInterrupt);
chenchen2020 2:9296823ea33d 265 interrupt.mode(PullUp);
chenchen2020 2:9296823ea33d 266 //wdt.kick();
4180_1 0:e09703934ff4 267 }
chenchen2020 2:9296823ea33d 268
chenchen2020 2:9296823ea33d 269 int main()
chenchen2020 2:9296823ea33d 270 {
chenchen2020 2:9296823ea33d 271 wait(1); //initialization
chenchen2020 2:9296823ea33d 272 //pc.printf("SystemCoreClock = %d Hz\r\n", SystemCoreClock);
chenchen2020 2:9296823ea33d 273 //wdt.kick(100);
chenchen2020 2:9296823ea33d 274
chenchen2020 2:9296823ea33d 275 //reset_mode.fall(&reset);
chenchen2020 2:9296823ea33d 276 //reset_mode.rise(&reset_over);
chenchen2020 2:9296823ea33d 277 //reset_mode.mode(PullUp);
chenchen2020 2:9296823ea33d 278
chenchen2020 2:9296823ea33d 279 jawServo.period_ms(20);
chenchen2020 2:9296823ea33d 280 baseServo.period_ms(20);
4180_1 0:e09703934ff4 281 interrupt.fall(&fallInterrupt);
4180_1 0:e09703934ff4 282 interrupt.mode(PullUp);
4180_1 0:e09703934ff4 283
4180_1 0:e09703934ff4 284 while (1) {
chenchen2020 2:9296823ea33d 285 if(record_mode == 0 && reset_mode == 1) {
chenchen2020 2:9296823ea33d 286 redLED = 1;
chenchen2020 2:9296823ea33d 287 blueLED = 0;
chenchen2020 2:9296823ea33d 288 greenLED = 0;
chenchen2020 2:9296823ea33d 289 played = 0;
chenchen2020 2:9296823ea33d 290 //wdt.kick();
chenchen2020 2:9296823ea33d 291 } else if(play_back_mode == 0 && reset_mode == 1) {
chenchen2020 2:9296823ea33d 292 note = 0;
chenchen2020 2:9296823ea33d 293 redLED = 0;
chenchen2020 2:9296823ea33d 294 blueLED = 1;
chenchen2020 2:9296823ea33d 295 greenLED = 0;
chenchen2020 2:9296823ea33d 296 interrupt.fall(NULL); //disable interrupt
chenchen2020 2:9296823ea33d 297 //t.stop();
chenchen2020 2:9296823ea33d 298 //t.reset();
chenchen2020 2:9296823ea33d 299 //t_rest.stop();
chenchen2020 2:9296823ea33d 300 //t_rest.reset();
chenchen2020 2:9296823ea33d 301 for(int k = 0; k < mem_ind; k++) {
chenchen2020 2:9296823ea33d 302 mySpeaker.Play_Note(mem_note[k]);
chenchen2020 2:9296823ea33d 303 dance(mem_note[k]);
chenchen2020 2:9296823ea33d 304 if(reset_mode == 0){
chenchen2020 2:9296823ea33d 305 break;
chenchen2020 2:9296823ea33d 306 }
chenchen2020 2:9296823ea33d 307 wait(mem_duration[k]);
chenchen2020 2:9296823ea33d 308 }
chenchen2020 2:9296823ea33d 309 interrupt.fall(&fallInterrupt);
chenchen2020 2:9296823ea33d 310 interrupt.mode(PullUp);
chenchen2020 2:9296823ea33d 311 //wdt.kick();
chenchen2020 2:9296823ea33d 312 } else if(play_live_mode == 0 && reset_mode == 1) {
chenchen2020 2:9296823ea33d 313 note = 0;
chenchen2020 2:9296823ea33d 314 redLED = 0;
chenchen2020 2:9296823ea33d 315 blueLED = 0;
chenchen2020 2:9296823ea33d 316 greenLED = 1;
chenchen2020 2:9296823ea33d 317 played = 0;
chenchen2020 2:9296823ea33d 318 //wdt.kick();
chenchen2020 2:9296823ea33d 319 } else if(stop_mode == 0 && reset_mode == 1) {
chenchen2020 2:9296823ea33d 320 note = 0;
chenchen2020 2:9296823ea33d 321 redLED = 0;
chenchen2020 2:9296823ea33d 322 blueLED = 0;
chenchen2020 2:9296823ea33d 323 greenLED = 0;
chenchen2020 2:9296823ea33d 324 //wdt.kick();
chenchen2020 2:9296823ea33d 325 } else if(reset_mode == 0) {
chenchen2020 2:9296823ea33d 326 //wdt.kick();
chenchen2020 2:9296823ea33d 327 note = 0;
chenchen2020 2:9296823ea33d 328 redLED = 0;
chenchen2020 2:9296823ea33d 329 blueLED = 0;
chenchen2020 2:9296823ea33d 330 greenLED = 0;
chenchen2020 2:9296823ea33d 331 interrupt.fall(NULL);
chenchen2020 2:9296823ea33d 332 mySpeaker.Play_Note(0);
chenchen2020 2:9296823ea33d 333 if(!timer_begin) {
chenchen2020 2:9296823ea33d 334 timer_begin = 1;
chenchen2020 2:9296823ea33d 335 reset_timer.start();
chenchen2020 2:9296823ea33d 336 }
chenchen2020 2:9296823ea33d 337 while(reset_mode == 0) {
chenchen2020 2:9296823ea33d 338
chenchen2020 2:9296823ea33d 339 //t_base.stop();
chenchen2020 2:9296823ea33d 340 //dt += t_base.read();
chenchen2020 2:9296823ea33d 341 //t_base.reset();
chenchen2020 2:9296823ea33d 342
chenchen2020 2:9296823ea33d 343 //rotation orientation back to original position
chenchen2020 2:9296823ea33d 344 //baseServo.pulsewidth_ms(1.9);
chenchen2020 2:9296823ea33d 345 //wait(dt);
chenchen2020 2:9296823ea33d 346 //dt = 0;
chenchen2020 2:9296823ea33d 347 if(reset_timer.read() > 3) {
chenchen2020 2:9296823ea33d 348 for(int n = 0; n < 160; n++) {
chenchen2020 2:9296823ea33d 349 mem_note[n] = 0;
chenchen2020 2:9296823ea33d 350 mem_duration[n] = 0;
chenchen2020 2:9296823ea33d 351 }
chenchen2020 2:9296823ea33d 352 }
chenchen2020 2:9296823ea33d 353 //wdt.kick();
chenchen2020 2:9296823ea33d 354 }
chenchen2020 2:9296823ea33d 355 reset_timer.stop();
chenchen2020 2:9296823ea33d 356 reset_timer.reset();
chenchen2020 2:9296823ea33d 357 timer_begin = 1;
chenchen2020 2:9296823ea33d 358 mem_ind = 0;
chenchen2020 2:9296823ea33d 359 interrupt.fall(&fallInterrupt);
chenchen2020 2:9296823ea33d 360 interrupt.mode(PullUp);
chenchen2020 1:c704bea518d8 361 }
chenchen2020 2:9296823ea33d 362 //wdt.kick();
4180_1 0:e09703934ff4 363 }
4180_1 0:e09703934ff4 364 }
4180_1 0:e09703934ff4 365
4180_1 0:e09703934ff4 366
4180_1 0:e09703934ff4 367
chenchen2020 2:9296823ea33d 368