MX28IDcheck

Dependencies:   MX28 mbed

Committer:
kikutake
Date:
Thu Oct 08 08:33:35 2015 +0000
Revision:
0:4d6b7e99b6fe
MX28IDcheck

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kikutake 0:4d6b7e99b6fe 1 #include "mbed.h"
kikutake 0:4d6b7e99b6fe 2 #include "MX28.h"
kikutake 0:4d6b7e99b6fe 3
kikutake 0:4d6b7e99b6fe 4 Serial pc(USBTX,USBRX); /*パソコンとの通信*/
kikutake 0:4d6b7e99b6fe 5 MX28 mx28(p13,p14,57600);
kikutake 0:4d6b7e99b6fe 6
kikutake 0:4d6b7e99b6fe 7 int main() {
kikutake 0:4d6b7e99b6fe 8 pc.baud(57600);
kikutake 0:4d6b7e99b6fe 9
kikutake 0:4d6b7e99b6fe 10 while(1){
kikutake 0:4d6b7e99b6fe 11 for(int ID=1;ID<=5;ID++){
kikutake 0:4d6b7e99b6fe 12 mx28.SetMovingSpeed(ID,0x0010);
kikutake 0:4d6b7e99b6fe 13 mx28.SetGoalPosition(ID,0x00F0);
kikutake 0:4d6b7e99b6fe 14 wait(0.5);
kikutake 0:4d6b7e99b6fe 15 mx28.SetGoalPosition(ID,0x0FFF);
kikutake 0:4d6b7e99b6fe 16 wait(0.5);
kikutake 0:4d6b7e99b6fe 17 }
kikutake 0:4d6b7e99b6fe 18 }
kikutake 0:4d6b7e99b6fe 19 }