diff --git a/examples/Motor/Motor.cpp b/examples/Motor/Motor.cpp
index 5947d1f..7e41c6f 100644
--- a/examples/Motor/Motor.cpp
+++ b/examples/Motor/Motor.cpp
@@ -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();
 
 }