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-09-28
Revision:
0:525558a26464
Child:
1:80f098c05d4b

File content as of revision 0:525558a26464:

#include "PID.h"
#include "QEI.h"
#include "MODSERIAL.h"
#include "mbed.h"
#include "config.h"  // settings and pin configurations



#define DEBUG // send debug data to serial console
#define ARM  // enable motors

motorInit(); 

int main()
{
    while (true) {
        checkSwitches();
        readEMG();
        motorControl();
        servoControl();
        pumpControl();
                
        
        #ifdef DEBUG
            debugProcess();
        #endif
    }
}