NagaokaRoboticsClub_mbedTeam / Mbed 2 deprecated Yanagi_robo

ikarashi kunn----- nya---

Dependencies:   MotorDriverController mbed

main.cpp

Committer:
WAT34
Date:
2017-07-13
Revision:
0:0c5a2df4bdb6

File content as of revision 0:0c5a2df4bdb6:

#include "mbed.h"
#include "MotorDriverController.h"
#include "constants.h"

MDC motors[4];

int main() {
    for(int i = 0; i < 4;i++)
    {
        motors[i].setAddr(0,i);
    }  
    while(true) {
        motors[0].write(0.7);
        motors[1].write(-0.7);
        motors[2].write(0);
        motors[3].write(0);
        
        wait(2);
        motors[0].write(0);
        motors[1].write(0);
        motors[2].write(0.7);
        motors[3].write(-0.7);
        
        wait(2);
        motors[0].write(0.7);
        motors[1].write(0.7);
        motors[2].write(0.7);
        motors[3].write(0.7);
        wait(2);
        
        motors[0].write(-0.7);
        motors[1].write(-0.7);
        motors[2].write(-0.7);
        motors[3].write(-0.7);
        wait(2);
    }
}