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:
39:41635b1b11de
Parent:
32:2006977785f5
Child:
47:e493567999d7

File content as of revision 39:41635b1b11de:

#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.01f);
debug.attach(&debug_activate, 0.01f);
motor.attach(&motor_activate, 0.01f);

    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();
        }
    }
}