diff --git a/examples/Motor/Motor.cpp b/examples/Motor/Motor.cpp
index 5de6375..c0579bd 100644
--- a/examples/Motor/Motor.cpp
+++ b/examples/Motor/Motor.cpp
@@ -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);
 
 }