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

new motor example

Browse Source
This commit is contained in:
shrkey
2016-10-10 22:25:24 +01:00
parent b2e758c50b
commit ef3b6ab944
1 changed files with 76 additions and 71 deletions
Download Patch File Download Diff File Expand all files Collapse all files

147
examples/Motor/Motor.cpp
View File

@@ -28,83 +28,88 @@ int main()
dw.initialize();
DW_Motor *dw1 = dw.getMotor(1);
DW_Motor *dw2 = dw.getMotor(2);
DW_Motor *dw3 = dw.getMotor(3);
DW_Motor *dw4 = dw.getMotor(4);
DW_Motor *dw5 = dw.getMotor(5);
DW_Motor *dw6 = dw.getMotor(6);
dw1->off();
dw1->setMotorSpeed( 200 );
usleep(1000000);
dw1->off();
// dw.setMotorOff(1);
// dw.setMotorOff(2);
// dw.setMotorOff(3);
// dw.setMotorOff(4);
// dw.setMotorOff(5);
// dw.setMotorOff(6);
// usleep(1000000);
dw1->off();
dw2->off();
dw3->off();
dw4->off();
dw5->off();
dw6->off();
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);
printf("Set forward - \n");
printf("Motor 1\n");
dw1->setMotorSpeed( 255 );
usleep(1000000);
printf("Motor 2\n");
dw2->setMotorSpeed( 255 );
usleep(1000000);
printf("Motor 3\n");
dw3->setMotorSpeed( 255 );
usleep(1000000);
printf("Motor 4\n");
dw4->setMotorSpeed( 255 );
usleep(1000000);
printf("Motor 5\n");
dw5->setMotorSpeed( 255 );
usleep(1000000);
printf("Motor 6\n");
dw6->setMotorSpeed( 255 );
usleep(1000000);
printf("Stopping - \n");
printf("Motor 1\n");
dw1->setMotorSpeed( 0 );
usleep(1000000);
printf("Motor 2\n");
dw2->setMotorSpeed( 0 );
usleep(1000000);
printf("Motor 3\n");
dw3->setMotorSpeed( 0 );
usleep(1000000);
printf("Motor 4\n");
dw4->setMotorSpeed( 0 );
usleep(1000000);
printf("Motor 5\n");
dw5->setMotorSpeed( 0 );
usleep(1000000);
printf("Motor 6\n");
dw6->setMotorSpeed( 0 );
usleep(1000000);
printf("Set reverse - \n");
printf("Motor 1\n");
dw1->setMotorSpeed( -255 );
usleep(1000000);
printf("Motor 2\n");
dw2->setMotorSpeed( -255 );
usleep(1000000);
printf("Motor 3\n");
dw3->setMotorSpeed( -255 );
usleep(1000000);
printf("Motor 4\n");
dw4->setMotorSpeed( -255 );
usleep(1000000);
printf("Motor 5\n");
dw5->setMotorSpeed( -255 );
usleep(1000000);
printf("Motor 6\n");
dw6->setMotorSpeed( -255 );
usleep(1000000);
printf("All off \n");
dw1->off();
dw2->off();
dw3->off();
dw4->off();
dw5->off();
dw6->off();
}