diff --git a/Medicina/Servers/MedicinaMinorServo/src/MSBossTracker.cpp b/Medicina/Servers/MedicinaMinorServo/src/MSBossTracker.cpp index b8d033d4f21e4f33722e3726241da64a75d28a41..941d9dca383e671d58ee95aa69e65dc988e89451 100644 --- a/Medicina/Servers/MedicinaMinorServo/src/MSBossTracker.cpp +++ b/Medicina/Servers/MedicinaMinorServo/src/MSBossTracker.cpp @@ -58,16 +58,16 @@ void MSBossTracker::runLoop() MedMinorServoPosition offset_position, correct_position; IRA::CTimer timer; - bool tracking = false; + while(!(m_status->ready)) { + usleep(5000000); if(timer.elapsed() > READY_MAX_WAIT) { throw ServoTimeoutError("Timeout wating for Minor Servo to became ready"); } - } - + m_status->elevation_tracking = true; if(m_status->elevation_tracking) { try { diff --git a/Medicina/Servers/MedicinaMinorServo/src/MinorServoBossImpl.cpp b/Medicina/Servers/MedicinaMinorServo/src/MinorServoBossImpl.cpp index 98353f0d0b54a61f1d86ac243c5ffd5ab844a41e..3b0d7e80bf31ab99bf556af8ea36b98e39588d76 100644 --- a/Medicina/Servers/MedicinaMinorServo/src/MinorServoBossImpl.cpp +++ b/Medicina/Servers/MedicinaMinorServo/src/MinorServoBossImpl.cpp @@ -856,7 +856,7 @@ throw (MinorServoErrors::MinorServoErrorsEx) m_tracking_thread_ptr = NULL; } - m_servo_status.elevation_tracking = true; + //m_servo_status.elevation_tracking = true; try { TrackerThreadParameters params(&m_servo_status, m_control,