From de92fa35cf149be8d7767e19b5e52855b7106a7a Mon Sep 17 00:00:00 2001
From: Peter Wu <peter@lekensteyn.nl>
Date: Wed, 17 Jun 2015 16:29:17 +0200
Subject: Enable sensing when motor is enabled

---
 Venus_Skeleton/Venus_Skeleton.ino | 5 ++---
 1 file 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;
 	}
-- 
cgit v1.2.1