File content as of revision 52:320f910ca6ca:

#include "mbed.h"
#include "pin_config.h"
#include "bot.h"

Bot OCTOPUS;
Serial pc(USBTX, USBRX, 115200);
Timer t;
Timer tc;

int main()
{
    //pc.printf("const\n\r");
    t.reset();
    tc.reset();
    while(1) {
        //printf("loop\n\r");
        //tc.start();
        //t.start();
        OCTOPUS.confirmPad2();
        //t.stop();
        //pc.printf("%f ",t.read());
        //t.start();
        //wait(0.01);
        OCTOPUS.confirmPad1();
        //pc.printf("\r\n");
        //t.stop();
        //pc.printf("%f ",t.read());
        //t.start();
        //OCTOPUS.controllDrive();
        OCTOPUS.controllDrive2();
        // OCTOPUS.controllDrive3();
        //OCTOPUS.controllDrive4();
        //t.stop();
        //t.start();
        OCTOPUS.controllMech();
        //OCTOPUS.calibrate();
        //t.stop();
        //pc.printf("%f ",t.read());
        //wait(fabsf(0.12-t.read()));
        //t.reset();
        //tc.stop();
        //OCTOPUS.checkConnection();
        //OCTOPUS.checkDegree();
        //OCTOPUS.checkPacket();
        //OCTOPUS.checkReceiveData();
        //pc.printf("%f ",tc.read());
        //tc.reset();
        wait(INTERVAL);
    }
}