h3n3/darkwater_cplus_640
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

motor test

Browse Source
This commit is contained in:
shrkey
2016-10-10 21:57:26 +01:00
parent ab5dddccb2
commit c007b870e5
1 changed files with 77 additions and 70 deletions
Download Patch File Download Diff File Expand all files Collapse all files

147
examples/Motor/Motor.cpp
View File

@@ -27,77 +27,84 @@ int main()
DW640 dw;
dw.initialize();
dw.setMotorOff(1);
dw.setMotorOff(2);
dw.setMotorOff(3);
dw.setMotorOff(4);
dw.setMotorOff(5);
dw.setMotorOff(6);
usleep(1000000);
DW_Motor *dw1 = dw.getMotor(1);
printf("Set forward - \n");
printf("Motor 1\n");
dw.setMotorSpeed( 1, 255 );
dw1.off();
dw1.setMotorSpeed( 200 );
usleep(1000000);
printf("Motor 2\n");
dw.setMotorSpeed( 2, 255 );
usleep(1000000);
printf("Motor 3\n");
dw.setMotorSpeed( 3, 255 );
usleep(1000000);
printf("Motor 4\n");
dw.setMotorSpeed( 4, 255 );
usleep(1000000);
printf("Motor 5\n");
dw.setMotorSpeed( 5, 255 );
usleep(1000000);
printf("Motor 6\n");
dw.setMotorSpeed( 6, 255 );
usleep(1000000);
printf("Stopping - \n");
printf("Motor 1\n");
dw.setMotorSpeed( 1, 0 );
usleep(1000000);
printf("Motor 2\n");
dw.setMotorSpeed( 2, 0 );
usleep(1000000);
printf("Motor 3\n");
dw.setMotorSpeed( 3, 0 );
usleep(1000000);
printf("Motor 4\n");
dw.setMotorSpeed( 4, 0 );
usleep(1000000);
printf("Motor 5\n");
dw.setMotorSpeed( 5, 0 );
usleep(1000000);
printf("Motor 6\n");
dw.setMotorSpeed( 6, 0 );
usleep(1000000);
printf("Set reverse - \n");
printf("Motor 1\n");
dw.setMotorSpeed( 1, -255 );
usleep(1000000);
printf("Motor 2\n");
dw.setMotorSpeed( 2, -255 );
usleep(1000000);
printf("Motor 3\n");
dw.setMotorSpeed( 3, -255 );
usleep(1000000);
printf("Motor 4\n");
dw.setMotorSpeed( 4, -255 );
usleep(1000000);
printf("Motor 5\n");
dw.setMotorSpeed( 5, -255 );
usleep(1000000);
printf("Motor 6\n");
dw.setMotorSpeed( 6, -255 );
usleep(1000000);
printf("All off \n");
dw.setMotorOff(1);
dw.setMotorOff(2);
dw.setMotorOff(3);
dw.setMotorOff(4);
dw.setMotorOff(5);
dw.setMotorOff(6);
dw1.off();
// dw.setMotorOff(1);
// dw.setMotorOff(2);
// dw.setMotorOff(3);
// dw.setMotorOff(4);
// dw.setMotorOff(5);
// dw.setMotorOff(6);
// usleep(1000000);
// printf("Set forward - \n");
// printf("Motor 1\n");
// dw.setMotorSpeed( 1, 255 );
// usleep(1000000);
// printf("Motor 2\n");
// dw.setMotorSpeed( 2, 255 );
// usleep(1000000);
// printf("Motor 3\n");
// dw.setMotorSpeed( 3, 255 );
// usleep(1000000);
// printf("Motor 4\n");
// dw.setMotorSpeed( 4, 255 );
// usleep(1000000);
// printf("Motor 5\n");
// dw.setMotorSpeed( 5, 255 );
// usleep(1000000);
// printf("Motor 6\n");
// dw.setMotorSpeed( 6, 255 );
// usleep(1000000);
// printf("Stopping - \n");
// printf("Motor 1\n");
// dw.setMotorSpeed( 1, 0 );
// usleep(1000000);
// printf("Motor 2\n");
// dw.setMotorSpeed( 2, 0 );
// usleep(1000000);
// printf("Motor 3\n");
// dw.setMotorSpeed( 3, 0 );
// usleep(1000000);
// printf("Motor 4\n");
// dw.setMotorSpeed( 4, 0 );
// usleep(1000000);
// printf("Motor 5\n");
// dw.setMotorSpeed( 5, 0 );
// usleep(1000000);
// printf("Motor 6\n");
// dw.setMotorSpeed( 6, 0 );
// usleep(1000000);
// printf("Set reverse - \n");
// printf("Motor 1\n");
// dw.setMotorSpeed( 1, -255 );
// usleep(1000000);
// printf("Motor 2\n");
// dw.setMotorSpeed( 2, -255 );
// usleep(1000000);
// printf("Motor 3\n");
// dw.setMotorSpeed( 3, -255 );
// usleep(1000000);
// printf("Motor 4\n");
// dw.setMotorSpeed( 4, -255 );
// usleep(1000000);
// printf("Motor 5\n");
// dw.setMotorSpeed( 5, -255 );
// usleep(1000000);
// printf("Motor 6\n");
// dw.setMotorSpeed( 6, -255 );
// usleep(1000000);
// printf("All off \n");
// dw.setMotorOff(1);
// dw.setMotorOff(2);
// dw.setMotorOff(3);
// dw.setMotorOff(4);
// dw.setMotorOff(5);
// dw.setMotorOff(6);
}