Project Paint / Mbed 2 deprecated arm_control

Dependencies:   mbed QEI biquadFilter

test_main.cpp

Committer:
ronvbree
Date:
2016-11-03
Revision:
14:551049a798a3
Parent:
11:57f0ab4d0e99
Child:
15:5d2bce2abd41
Child:
18:1c9dc6caab9d

File content as of revision 14:551049a798a3:

#include "mbed.h"
#include "robot.h"

// ====== Hardware stuff ======

Robot robot;

AnalogIn emg1(A0);
AnalogIn emg2(A1);

DigitalOut red(LED_RED);
DigitalOut green(LED_GREEN);
DigitalOut blue(LED_BLUE);

//====== Constants =====

enum RobotCommand{NOTHING, UP, DOWN, FORWARD, BACKWARD};
enum ProgramState{CALIBRATING, UPDOWN, FORBACK};

const float sampleFrequency = 500;
const float sampleTime = 1.0f/sampleFrequency;


//====== Program Variables ======

ProgramState progState;
RobotCommand robotCommand;


//====== Functions ======


void calibrate(void) {
    //Calibrate function -- blocking.
    //Calculates and sets both emg1threshold and emg2 threshold
    
    
    
}

void run() {
    //Run function -- blocking
    //runs the calibrated robot

}


//int main() {
//    progState = CALIBRATING;
//    
//    calibrate();
//    
//    progState = UPDOWN;
//    robotCommand = NOTHING;
//    
//    run();
//    
//    while(true);
//    return 0;
//}