Commit 58da6c38 authored by Fabio Vitello's avatar Fabio Vitello
Browse files

#588 fixed enabling of Elevation Tracking on setup

parent 9e043a0a

Medicina/Servers/MedicinaMinorServo/src/MinorServoBossImpl.cpp

+11 −11
Original line number Diff line number Diff line
@@ -327,6 +327,17 @@ MinorServoBossImpl::setup(const char *config) throw ( 
        setupImpl(config);

        CUSTOM_LOG(LM_FULL_INFO, "MinorServo::MinorServoBossImpl::setup",

                   (LM_NOTICE, "Minor Servo Setup: %s", config));

                   //enable elevation tracking

        try

        {

            if (isElevationTrackingEn())

                setElevationTrackingImpl(IRA::CString("ON"));

        }

        catch (...)

        {

            THROW_EX(MinorServoErrors, SetupErrorEx, "cannot turn the tracking on",

                     false);

        }

    }

    catch (MinorServoErrors::SetupErrorExImpl& ex) {

        ex.log(LM_WARNING);
@@ -402,17 +413,6 @@ throw (MinorServoErrors::SetupErrorExImpl) 
        CUSTOM_LOG(LM_FULL_INFO, "MinorServo::MinorServoBossImpl::setupImpl",

                   (LM_DEBUG, "Started setup positioning thread"));



        //enable elevation tracking

        try

        {

            if (isElevationTrackingEn())

                setElevationTrackingImpl(IRA::CString("ON"));

        }

        catch (...)

        {

            THROW_EX(MinorServoErrors, SetupErrorEx, "cannot turn the tracking on",

                     false);

        }

    }catch(const ServoTimeoutError& ste){

        THROW_EX(MinorServoErrors, SetupErrorEx, ste.what(), false);

    }catch(const ServoConnectionError& sce){