eive-obsw/mission/controller/AcsController.h

78 lines
3.2 KiB
C
Raw Normal View History

2022-08-12 12:29:28 +02:00
#ifndef MISSION_CONTROLLER_ACSCONTROLLER_H_
#define MISSION_CONTROLLER_ACSCONTROLLER_H_
#include <fsfw/controller/ExtendedControllerBase.h>
#include "controllerdefinitions/AcsCtrlDefinitions.h"
2022-09-16 12:28:39 +02:00
#include "eive/objects.h"
2022-08-15 10:50:19 +02:00
#include "fsfw_hal/devicehandlers/MgmLIS3MDLHandler.h"
#include "fsfw_hal/devicehandlers/MgmRM3100Handler.h"
2022-08-17 09:27:19 +02:00
#include "mission/devices/devicedefinitions/SusDefinitions.h"
2022-10-20 15:08:33 +02:00
#include "mission/devices/devicedefinitions/imtqHandlerDefinitions.h"
2022-08-12 12:29:28 +02:00
2022-08-15 09:58:18 +02:00
class AcsController : public ExtendedControllerBase {
public:
2022-08-15 10:50:19 +02:00
static constexpr dur_millis_t INIT_DELAY = 500;
2022-08-15 09:58:18 +02:00
AcsController(object_id_t objectId);
2022-08-12 12:29:28 +02:00
2022-08-15 09:58:18 +02:00
private:
2022-08-15 10:50:19 +02:00
enum class InternalState { STARTUP, INITIAL_DELAY, READY };
InternalState internalState = InternalState::STARTUP;
2022-08-12 12:29:28 +02:00
ReturnValue_t handleCommandMessage(CommandMessage* message) override;
void performControlOperation() override;
ReturnValue_t initializeLocalDataPool(localpool::DataPool& localDataPoolMap,
2022-08-15 09:58:18 +02:00
LocalDataPoolManager& poolManager) override;
2022-08-12 12:29:28 +02:00
LocalPoolDataSetBase* getDataSetHandle(sid_t sid) override;
// Mode abstract functions
ReturnValue_t checkModeCommand(Mode_t mode, Submode_t submode,
2022-08-15 09:58:18 +02:00
uint32_t* msToReachTheMode) override;
2022-08-12 12:29:28 +02:00
// MGMs
2022-09-15 17:46:41 +02:00
acsctrl::MgmDataRaw mgmData;
2022-08-15 10:50:19 +02:00
MGMLIS3MDL::MgmPrimaryDataset mgm0Lis3Set =
MGMLIS3MDL::MgmPrimaryDataset(objects::MGM_0_LIS3_HANDLER);
RM3100::Rm3100PrimaryDataset mgm1Rm3100Set =
RM3100::Rm3100PrimaryDataset(objects::MGM_1_RM3100_HANDLER);
MGMLIS3MDL::MgmPrimaryDataset mgm2Lis3Set =
MGMLIS3MDL::MgmPrimaryDataset(objects::MGM_2_LIS3_HANDLER);
RM3100::Rm3100PrimaryDataset mgm3Rm3100Set =
RM3100::Rm3100PrimaryDataset(objects::MGM_3_RM3100_HANDLER);
2022-08-18 17:27:39 +02:00
IMTQ::RawMtmMeasurementSet imtqMgmSet = IMTQ::RawMtmMeasurementSet(objects::IMTQ_HANDLER);
2022-10-19 15:36:57 +02:00
IMTQ::DipoleActuationSet dipoleSet = IMTQ::DipoleActuationSet(objects::IMTQ_HANDLER);
2022-08-15 10:50:19 +02:00
2022-08-15 11:19:08 +02:00
PoolEntry<float> mgm0PoolVec = PoolEntry<float>(3);
PoolEntry<float> mgm1PoolVec = PoolEntry<float>(3);
PoolEntry<float> mgm2PoolVec = PoolEntry<float>(3);
PoolEntry<float> mgm3PoolVec = PoolEntry<float>(3);
2022-08-18 18:18:44 +02:00
PoolEntry<float> imtqMgmPoolVec = PoolEntry<float>(3);
2022-08-15 11:19:08 +02:00
PoolEntry<uint8_t> imtqCalActStatus = PoolEntry<uint8_t>();
2022-08-15 11:57:57 +02:00
2022-08-15 10:50:19 +02:00
void copyMgmData();
2022-08-12 12:29:28 +02:00
2022-08-17 09:27:19 +02:00
// Sun Sensors
2022-08-19 15:49:22 +02:00
std::array<SUS::SusDataset, 12> susSets{
SUS::SusDataset(objects::SUS_0_N_LOC_XFYFZM_PT_XF),
SUS::SusDataset(objects::SUS_1_N_LOC_XBYFZM_PT_XB),
SUS::SusDataset(objects::SUS_2_N_LOC_XFYBZB_PT_YB),
SUS::SusDataset(objects::SUS_3_N_LOC_XFYBZF_PT_YF),
SUS::SusDataset(objects::SUS_4_N_LOC_XMYFZF_PT_ZF),
SUS::SusDataset(objects::SUS_5_N_LOC_XFYMZB_PT_ZB),
SUS::SusDataset(objects::SUS_6_R_LOC_XFYBZM_PT_XF),
SUS::SusDataset(objects::SUS_7_R_LOC_XBYBZM_PT_XB),
SUS::SusDataset(objects::SUS_8_R_LOC_XBYBZB_PT_YB),
SUS::SusDataset(objects::SUS_9_R_LOC_XBYBZB_PT_YF),
SUS::SusDataset(objects::SUS_10_N_LOC_XMYBZF_PT_ZF),
SUS::SusDataset(objects::SUS_11_R_LOC_XBYMZB_PT_ZB),
2022-08-17 09:27:19 +02:00
};
2022-08-15 10:50:19 +02:00
// Initial delay to make sure all pool variables have been initialized their owners
Countdown initialCountdown = Countdown(INIT_DELAY);
2022-08-12 12:29:28 +02:00
};
#endif /* MISSION_CONTROLLER_ACSCONTROLLER_H_ */