diff --git a/src/C++/Driver/src/test.cpp b/src/C++/Driver/src/test.cpp
index f08b2cb..9609b6b 100644
--- a/src/C++/Driver/src/test.cpp
+++ b/src/C++/Driver/src/test.cpp
@@ -41,10 +41,10 @@ int command(){
 
 	switch(input){
 		case 1:
-			robot.forward(1024, 1);
+			robot.goStraight(1);
 			robot.doRotation(90);
 			robot.forward(1024, -1);
-			robot.doRotation(-90);
+			robot.goStraight(-1);
 			break;
 		case 2:
 			robot.doRotation(90);