a

Dependencies:   Locate Move Servo button mbed

Fork of 3servotest by 涼太郎 中村

main.cpp

Committer:
sakanakuuun
Date:
2016-09-05
Revision:
7:43692ae2d20a
Parent:
6:931d51a70200
Child:
8:21f40f92215f

File content as of revision 7:43692ae2d20a:

#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);
        
        pmove_to_dir(X_PLUS, 1200, 0);
        pmove_to_dir(Y_PLUS, 1200, 300);
        pmove_to_dir(X_MINUS, 0, 300);
        pmove_to_dir(Y_MINUS, 0, 0);
        back();
    }
    while(1) {
        update();
    }
}