ECE3872 HW/SW Project Code
Dependencies: mbed Servo mbed-rtos 4DGL-uLCD-SE PinDetect X_NUCLEO_53L0A1
main.cpp
- Committer:
- trmontgomery
- Date:
- 2020-04-14
- Revision:
- 26:2063ee8419cc
- Parent:
- 25:7764baddb7bc
File content as of revision 26:2063ee8419cc:
#include "mbed.h" #include <iostream> #include <vector> #include "speaker_out.h" #include "motor_ctl.h" #include "SongPlayer.h" DigitalOut myled1(LED1); DigitalOut myled2(LED2); DigitalOut myled3(LED3); DigitalOut myled4(LED4); // State Machine control global variables bool X; //reset bool P; //play bool S; //stop bool R; //record bool E; //erase enum sm_state {sRESET, sSTOP, sRECORD, sPLAY, sERASE}; int curr_state = 1; Serial pc(USBTX,USBRX); Speaker mySpeaker(p26); float time_limit = 30; //Timer t; //SongPlayer music; //Puppet puppet; vector<float> song; //stores all notes recorded by user vector<string> dance; void reset(){ /* reset state: Initial state upon powering up the device 1. Cease all motion 2. Reset all motors to initial position 3. Mutes all audio 4. Goes to erase state if reset button is held down for at least 3 seconds 5. Goes to stop state according to rotary switch input 6. LED goes from green to red NOTE: ONLY exits to stop or erase state */ //puppet.reset(); //music.reset(); //led = red; //use rgb red for this } void stop(){ /* stop state: Initiated by rotary switch 1. Cease all motion 2. Stop recording 3. Mute all audio */ //puppet.stop(); //music.stop(); } void record(){ /* record state: Initiated by rotary switch 1. Cease all motion 2. Begin recording ToF inputs (distance and time) 3. Convert distances to corresponding audio frequencies 4. Append to list of frequencies 5. */ float freq; char note; t.start(); while(t.read() < 30){ note = pc.getc(); switch (note){ case 'a': freq = 523.25; dance.push_back(move_map[0]); break; case 's': freq = 554.37; dance.push_back(move_map[1]); break; case 'd': freq = 587.33; dance.push_back(move_map[2]); break; case 'f': freq = 622.25; dance.push_back(move_map[3]); break; case 'g': freq = 659.26; dance.push_back(move_map[4]); break; case 'h': freq = 698.46; dance.push_back(move_map[5]); break; case 'j': freq = 739.99; dance.push_back(move_map[6]); break; case 'k': freq = 783.99; dance.push_back(move_map[7]); break; case 'l': freq = 830.61; dance.push_back(move_map[8]); break; case 'q': freq = 880.00; dance.push_back(move_map[9]); break; case 'w': freq = 932.33; dance.push_back(move_map[10]); break; case 'e': freq = 987.77; dance.push_back(move_map[11]); break; } song.push_back(freq); mySpeaker.PlayNote(freq,0.2,0.5); } t.stop(); //curr_state = 3; } void play(){ /* play state: Initiated by rotary switch 1. wait a few seconds 2. begin reading list of frequencies while concurrently: - moving servo motors accordingly - playing corresponding sounds */ SongPlayer mySpeaker(p26, song); mySpeaker.PlaySong(DUR); } void erase(){ /* erase state: erases entire audio recording */ //song.erase(); } void state_machine_mgr(){ char key_input; X = 1; S = 0; R = 0; P = 0; E = 0; while(1) { if (pc.readable()) { // if they have pressed a key key_input = pc.getc(); if(key_input == '1') X=1; //toggle reset if(key_input == '2') S=1; //toggle stop if(key_input == '3') R=1; //toogle record if(key_input == '4') P=1; //toggle play if(key_input == '5') E=1; //toggle erase } //pc.printf("X: %d\n",X); // pc.printf("S: %d\n",S); // pc.printf("R: %d\n",R); // pc.printf("P: %d\n",P); // pc.printf("E: %d\n",E); // pc.printf("Current State %d\n",curr_state); switch(curr_state){ case 1: pc.printf("RESET\n"); P = 0; R = 0; if(E){ curr_state = 5; X = 0; }else if(S){ curr_state = 2; X = 0; } reset(); break; case 2: pc.printf("STOP\n"); E = 0; if(X){ curr_state = 1; S = 0; }else if(R){ curr_state = 3; S = 0; }else if(P){ curr_state = 4; S = 0; } stop(); break; case 3: pc.printf("RECORD\n"); E = 0; P = 0; if(X){ curr_state = 1; R = 0; }else if(S){ curr_state = 2; R = 0; } record(); break; case 4: pc.printf("PLAY\n"); E = 0; R = 0; if(X){ curr_state = 1; P = 0; }else if(S){ curr_state = 2; P = 0; } play(); break; case 5: pc.printf("ERASE\n"); S = 0; P = 0; R = 0; if(X){ curr_state = 1; E = 0; } erase(); break; } } } int main() { //initialize map of freq to movements move_map.push_back("1111"); move_map.push_back("1011"); move_map.push_back("0111"); move_map.push_back("1122"); move_map.push_back("1022"); move_map.push_back("0122"); move_map.push_back("1133"); move_map.push_back("1033"); move_map.push_back("0133"); move_map.push_back("0031"); move_map.push_back("0013"); move_map.push_back("1101"); state_machine_mgr(); //puppet_move(); //record(); }