refactored everything

devicehandlers/GyroL3GD20Handler.h

@@ -7,9 +7,9 @@
 #include <fsfw/devicehandlers/DeviceHandlerBase.h>
 #include <fsfw/globalfunctions/PeriodicOperationDivider.h>
 
-#ifndef L3GD20_GYRO_DEBUG
-#define L3GD20_GYRO_DEBUG   1
-#endif
+#ifndef FSFW_HAL_L3GD20_GYRO_DEBUG
+#define FSFW_HAL_L3GD20_GYRO_DEBUG   1
+#endif /* FSFW_HAL_L3GD20_GYRO_DEBUG */
 
 /**
  * @brief 	Device Handler for the L3GD20H gyroscope sensor
@@ -26,6 +26,7 @@ public:
             CookieIF* comCookie);
     virtual ~GyroHandlerL3GD20H();
 
+    void setGoNormalModeAtStartup();
 protected:
 
     /* DeviceHandlerBase overrides */
@@ -62,6 +63,7 @@ private:
     bool commandExecuted = false;
 
     uint8_t statusReg = 0;
+    bool goNormalModeImmediately = false;
 
     uint8_t ctrlReg1Value = L3GD20H::CTRL_REG_1_VAL;
     uint8_t ctrlReg2Value = L3GD20H::CTRL_REG_2_VAL;
@@ -74,7 +76,7 @@ private:
     // Set default value
     float sensitivity = L3GD20H::SENSITIVITY_00;
 
-#if L3GD20_GYRO_DEBUG == 1
+#if FSFW_HAL_L3GD20_GYRO_DEBUG == 1
     PeriodicOperationDivider* debugDivider = nullptr;
 #endif
 };