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-01
Revision:
1:80f098c05d4b
Parent:
0:525558a26464
Child:
3:47c76be6d402

File content as of revision 1:80f098c05d4b:

#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

#ifdef DEBUG
    MODSERIAL pc(USBTX, USBRX);
    pc.baud(115200);
#endif

enablePins();
motorInit(); 

int main()
{
    Timer time; // create timer object
    time.start(); // start the timer
    
    while (true) {
        checkSwitches();
        readEMG();
        motorControl();
        servoControl();
        pumpControl();
        
        #ifdef DEBUG
            debugProcess();
        #endif
    }
}