File content as of revision 1:7d218e9d2111:

#include "arm.h"

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

const PinName upperMotorControl = D6;
const PinName upperMotorDirection = D7;
const PinName lowerMotorControl = D5;
const PinName lowerMotorDirection = D4;

//Arm upperArm(50, upperMotorControl, upperMotorDirection);
//Arm lowerArm(50, lowerMotorControl, lowerMotorDirection);

const PinName emg1pin = A0;
const PinName emg2pin = A1;

AnalogIn emg1(emg1pin);
AnalogIn emg2(emg2Pin);

//====== Types =====

enum DirectionState{UP = true, DOWN = false};
enum ProgramState{CALIBRATING, RUNNING};

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

ProgramState progState;
DirectionState dirState;

float emg1threshold;
float emg2threshold;

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


void calibrate(void) {
    //Calibrate function.
    //Blocks
    
}


int main() {
    progState = CALIBRATING;
    calibrate();
    
    
    while(true);
    return 0;
}