diff options
Diffstat (limited to 'Venus_Skeleton/Venus_Skeleton.ino')
| -rw-r--r-- | Venus_Skeleton/Venus_Skeleton.ino | 2 |
1 files changed, 2 insertions, 0 deletions
diff --git a/Venus_Skeleton/Venus_Skeleton.ino b/Venus_Skeleton/Venus_Skeleton.ino index 9a8ba78..7718d8a 100644 --- a/Venus_Skeleton/Venus_Skeleton.ino +++ b/Venus_Skeleton/Venus_Skeleton.ino @@ -803,6 +803,7 @@ void confirmSample(int turretVal) { // Check if a sample is seen by the gripperSampleDetector if (data.sample_gripper_detected && (counterSampleConfirm == 1 || counterSampleConfirm == 3)) { stopMovement(); + DEBUG_PRINT("sample detected"); currValDirectionDegree = 0; counterSampleConfirm = 2; } @@ -829,6 +830,7 @@ void initialSequence() { do { moveStraight(0, CAL_INITIAL_DISTANCE2); } while(timerMovementStop); + opMode(OPMODE_WAIT); } void calculateOrientation() { |