Enable sensing when motor is enabled

1 files changed, 2 insertions, 3 deletions

diff --git a/Venus_Skeleton/Venus_Skeleton.ino b/Venus_Skeleton/Venus_Skeleton.ino
index 2bfc549..7215f71 100644
--- a/Venus_Skeleton/Venus_Skeleton.ino
+++ b/Venus_Skeleton/Venus_Skeleton.ino
@@ -458,6 +458,8 @@ void stopMovement() {
 	maneuver(0, 0);
 	timerMovementStart = 0;
 	timerMovementStop = 0;
+	// motor is stopped, allow sensor polling again.
+	turretSensingEnabled = true;
 }
 
 void stopAllServos() {
@@ -540,9 +542,6 @@ bool moveTurnTo(int degree) {
 			data.obstacle_turret_distances[k] = OBSTACLE_FAR_AWAY;
 		}
 
-		// allow the sensors to be read out again
-		turretSensingEnabled = true;
-
 		// rotation is completed.
 		return true;
 	}