a

Dependencies:   Locate Move Servo button mbed

Fork of 3rdcompfixstart by 涼太郎 中村

main.cpp

Committer:
sakanakuuun
Date:
2016-09-05
Revision:
6:931d51a70200
Parent:
5:97d9a34e5016
Child:
7:43692ae2d20a

File content as of revision 6:931d51a70200:

#include "mbed.h"
#include "math.h"
#include "locate.h"
#include "move.h"

int main()
{
    setup();
    initmotor();

    wait(1);

    while(1) {
        pmove_to_dir(X_PLUS, 600, 0);
        pmove_to_dir(Y_PLUS, 600, 600);
        pmove_to_dir(X_MINUS, 0, 600);
        pmove_to_dir(Y_MINUS, 0, 0);
    }
    //turn_abs_rad(PI/2);

    while(1) {
        update();
    }
}


/*
int main(){
    setup();
    initmotor();

    for(int i=0; i < 4; i++)
    {
        movelength(1200);
        turnccw();
    }
}*/