takeshi kikuchi / IDcheck

MX28IDcheck

Dependencies:   MX28 mbed

main.cpp

Committer:
kikutake
Date:
2015-10-08
Revision:
0:4d6b7e99b6fe

File content as of revision 0:4d6b7e99b6fe:

#include "mbed.h"
#include "MX28.h"

Serial pc(USBTX,USBRX);  /*パソコンとの通信*/
MX28 mx28(p13,p14,57600);

int main() {
    pc.baud(57600);
    
    while(1){
    for(int ID=1;ID<=5;ID++){
    mx28.SetMovingSpeed(ID,0x0010);
    mx28.SetGoalPosition(ID,0x00F0);
    wait(0.5);
    mx28.SetGoalPosition(ID,0x0FFF);
    wait(0.5);
    }
    }
}