Fix no Sensors for Control FDIR #858
@ -357,8 +357,7 @@ void AcsController::performPointingCtrl() {
|
|||||||
ptgCtrlStrat == acs::ControlModeStrategy::CTRL_NO_SENSORS_FOR_CONTROL) {
|
ptgCtrlStrat == acs::ControlModeStrategy::CTRL_NO_SENSORS_FOR_CONTROL) {
|
||||||
ptgCtrlLostCounter++;
|
ptgCtrlLostCounter++;
|
||||||
if (ptgCtrlLostCounter > acsParameters.onBoardParams.ptgCtrlLostTimer) {
|
if (ptgCtrlLostCounter > acsParameters.onBoardParams.ptgCtrlLostTimer) {
|
||||||
EventManagerIF::triggerEvent(objects::STAR_TRACKER, acs::PTG_CTRL_NO_ATTITUDE_INFORMATION, 0,
|
triggerEvent(acs::PTG_CTRL_NO_ATTITUDE_INFORMATION);
|
||||||
0);
|
|
||||||
ptgCtrlLostCounter = 0;
|
ptgCtrlLostCounter = 0;
|
||||||
}
|
}
|
||||||
guidance.resetValues();
|
guidance.resetValues();
|
||||||
|
@ -1,6 +1,8 @@
|
|||||||
#include "StrFdir.h"
|
#include "StrFdir.h"
|
||||||
|
|
||||||
#include "mission/acs/defs.h"
|
#include <eive/objects.h>
|
||||||
|
#include <fsfw/events/EventManagerIF.h>
|
||||||
|
#include <mission/acs/defs.h>
|
||||||
|
|
||||||
StrFdir::StrFdir(object_id_t strObject)
|
StrFdir::StrFdir(object_id_t strObject)
|
||||||
: DeviceHandlerFailureIsolation(strObject, objects::NO_OBJECT) {}
|
: DeviceHandlerFailureIsolation(strObject, objects::NO_OBJECT) {}
|
||||||
@ -12,3 +14,13 @@ ReturnValue_t StrFdir::eventReceived(EventMessage* event) {
|
|||||||
}
|
}
|
||||||
return DeviceHandlerFailureIsolation::eventReceived(event);
|
return DeviceHandlerFailureIsolation::eventReceived(event);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
ReturnValue_t StrFdir::initialize() {
|
||||||
|
ReturnValue_t result = DeviceHandlerFailureIsolation::initialize();
|
||||||
|
if (result != returnvalue::OK) {
|
||||||
|
return result;
|
||||||
|
}
|
||||||
|
EventManagerIF* manager = ObjectManager::instance()->get<EventManagerIF>(objects::EVENT_MANAGER);
|
||||||
|
return manager->subscribeToEvent(eventQueue->getId(),
|
||||||
|
event::getEventId(acs::PTG_CTRL_NO_ATTITUDE_INFORMATION));
|
||||||
|
}
|
||||||
|
@ -6,6 +6,7 @@
|
|||||||
class StrFdir : public DeviceHandlerFailureIsolation {
|
class StrFdir : public DeviceHandlerFailureIsolation {
|
||||||
public:
|
public:
|
||||||
StrFdir(object_id_t strObject);
|
StrFdir(object_id_t strObject);
|
||||||
|
ReturnValue_t initialize() override;
|
||||||
ReturnValue_t eventReceived(EventMessage* event) override;
|
ReturnValue_t eventReceived(EventMessage* event) override;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user