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