diff --git a/Modules/control/src/Utilities/terminal_control.cpp b/Modules/control/src/Utilities/terminal_control.cpp
index 7e388430a5..99197c6b7c 100755
--- a/Modules/control/src/Utilities/terminal_control.cpp
+++ b/Modules/control/src/Utilities/terminal_control.cpp
@@ -561,7 +561,7 @@ void mainloop2()
           Command_to_pub.source = NODE_NAME;
           Command_to_pub.Reference_State.Move_mode       = prometheus_msgs::PositionReference::XYZ_POS;
           Command_to_pub.Reference_State.Move_frame      = prometheus_msgs::PositionReference::BODY_FRAME;
-          Command_to_pub.Reference_State.yaw_ref             = YAW_STEP_SIZE;
+          Command_to_pub.Reference_State.yaw_ref             -= YAW_STEP_SIZE;
           move_pub.publish(Command_to_pub);
           
           cout << " " <<endl;
@@ -709,4 +709,4 @@ void Draw_in_rviz(const prometheus_msgs::PositionReference& pos_ref, bool draw_t
         reference_trajectory.poses = posehistory_vector_;
         ref_trajectory_pub.publish(reference_trajectory);
     }
-}
\ No newline at end of file
+}