control for robotic arm that can play chess using a granular gripper

Dependencies:   Encoder mbed HIDScope Servo MODSERIAL

Fork of chessRobot by a steenbeek

main.cpp

Committer:
annesteenbeek
Date:
2015-10-08
Revision:
48:3cf1eaf34926
Parent:
47:e493567999d7
Child:
50:b0cf07ca53cf

File content as of revision 48:3cf1eaf34926:

#include "mbed.h"
#include "config.h"  // settings and pin configurations
#include "actuators.h"
#include "buttons.h"
#include "debug.h"


Ticker switches, debug, motor;
volatile bool switches_go=false, debug_go=false, motor_go=false;

void switches_activate(){switches_go=true;};
void debug_activate(){debug_go=true;};
void motor_activate(){motor_go=true;};

int main(){
motorInit(); 
// calibrateMotors();

switches.attach(&switches_activate, 0.02f);
debug.attach(&debug_activate, 0.03f);
motor.attach(&motor_activate, 0.1f);

    while (true) {
        // readEMG();
        // servoControl();
        if(switches_go){
            switches_go=false;
            checkSwitches();
        }
        if(debug_go){
            debug_go=false;
            debugProcess();
        }
        if(motor_go){
            motor_go=false;
            motorControl();
        }
    }
}