eive-obsw/mission/devices/SusHandler.h

#ifndef MISSION_DEVICES_SusHandler_H_
#define MISSION_DEVICES_SusHandler_H_

#include <fsfw_hal/devicehandlers/devicedefinitions/mgmLis3Helpers.h>

#include "fsfw/devicehandlers/DeviceHandlerBase.h"
#include "fsfw/globalfunctions/PeriodicOperationDivider.h"
#include "mission/devices/devicedefinitions/acsPolling.h"
#include "mission/devices/devicedefinitions/susMax1227Helpers.h"

class PeriodicOperationDivider;

class SusHandler : public DeviceHandlerBase {
 public:
  static constexpr DeviceCommandId_t REQUEST = 0x70;
  static constexpr DeviceCommandId_t REPLY = 0x77;

  static const uint8_t INTERFACE_ID = CLASS_ID::MGM_LIS3MDL;
  static const uint8_t SUBSYSTEM_ID = SUBSYSTEM_ID::MGM_LIS3MDL;
  // Notifies a command to change the setup parameters
  static const Event CHANGE_OF_SETUP_PARAMETER = MAKE_EVENT(0, severity::LOW);

  SusHandler(uint32_t objectId, uint8_t susIdx, object_id_t deviceCommunication,
             CookieIF *comCookie);
  virtual ~SusHandler();

  void enablePeriodicPrintouts(bool enable, uint8_t divider);
  void setToGoToNormalMode(bool enable);

 protected:
  /** DeviceHandlerBase overrides */
  void doShutDown() override;
  void doStartUp() override;
  virtual uint32_t getTransitionDelayMs(Mode_t from, Mode_t to) override;
  ReturnValue_t buildCommandFromCommand(DeviceCommandId_t deviceCommand, const uint8_t *commandData,
                                        size_t commandDataLen) override;
  ReturnValue_t buildTransitionDeviceCommand(DeviceCommandId_t *id) override;
  ReturnValue_t buildNormalDeviceCommand(DeviceCommandId_t *id) override;
  ReturnValue_t scanForReply(const uint8_t *start, size_t len, DeviceCommandId_t *foundId,
                             size_t *foundLen) override;
  /**
   * This implementation is tailored towards space applications and will flag values larger
   * than 100 microtesla on X,Y and 150 microtesla on Z as invalid
   * @param id
   * @param packet
   * @return
   */
  virtual ReturnValue_t interpretDeviceReply(DeviceCommandId_t id, const uint8_t *packet) override;
  void fillCommandAndReplyMap() override;
  void modeChanged(void) override;
  ReturnValue_t initializeLocalDataPool(localpool::DataPool &localDataPoolMap,
                                        LocalDataPoolManager &poolManager) override;
  LocalPoolDataSetBase *getDataSetHandle(sid_t sid) override;

 private:
  susMax1227::SusDataset dataset;
  acs::SusRequest request{};
  uint8_t susIdx;

  uint32_t transitionDelay = 1000;
  bool goToNormalMode = false;

  PoolEntry<float> tempC = PoolEntry<float>({0.0});
  PoolEntry<uint16_t> channelVec = PoolEntry<uint16_t>({0, 0, 0, 0, 0, 0});

  enum class InternalState {
    NONE,
    STARTUP,
    SHUTDOWN,
  };

  InternalState internalState = InternalState::NONE;
  bool commandExecuted = false;

  ReturnValue_t prepareRequest(acs::SimpleSensorMode mode);
};

#endif /* MISSION_DEVICES_SusHandler_H_ */