1 files changed, 258 insertions, 0 deletions
diff --git a/firmware/memory_chip_gone/Utilities/lpm/tiny_lpm/stm32_lpm.c b/firmware/memory_chip_gone/Utilities/lpm/tiny_lpm/stm32_lpm.c
new file mode 100644
index 0000000..8f4e7cd
--- /dev/null
+++ b/firmware/memory_chip_gone/Utilities/lpm/tiny_lpm/stm32_lpm.c
@@ -0,0 +1,258 @@
+/**
+ ******************************************************************************
+ * @file    stm32_lpm.c
+ * @author  MCD Application Team
+ * @brief   Low Power Manager
+ ******************************************************************************
+ * @attention
+ *
+ * <h2><center>&copy; Copyright (c) 2019 STMicroelectronics. 
+ * All rights reserved.</center></h2>
+ *
+ * This software is licensed under terms that can be found in the LICENSE file
+ * in the root directory of this software component.
+ * If no LICENSE file comes with this software, it is provided AS-IS.
+ *
+ ******************************************************************************
+ */
+
+/* Includes ------------------------------------------------------------------*/
+#include "stm32_lpm.h"
+#include "utilities_conf.h"
+
+/** @addtogroup TINY_LPM
+  * @{
+  */
+
+/* Private typedef -----------------------------------------------------------*/
+/* Private macros ------------------------------------------------------------*/
+/** @defgroup TINY_LPM_Private_macros TINY LPM private macros
+  * @{
+  */
+
+/**
+ * @brief macro used to initialized the critical section
+ */
+#ifndef UTIL_LPM_INIT_CRITICAL_SECTION
+  #define UTIL_LPM_INIT_CRITICAL_SECTION( )
+#endif
+
+/**
+ * @brief macro used to enter the critical section
+ */
+#ifndef UTIL_LPM_ENTER_CRITICAL_SECTION
+  #define UTIL_LPM_ENTER_CRITICAL_SECTION( )    UTILS_ENTER_CRITICAL_SECTION( )
+#endif
+
+/**
+ * @brief macro used to exit the critical section
+ */
+#ifndef UTIL_LPM_EXIT_CRITICAL_SECTION
+  #define UTIL_LPM_EXIT_CRITICAL_SECTION( )     UTILS_EXIT_CRITICAL_SECTION( )
+#endif
+
+/**
+ * @brief macro used to enter the critical section when Entering Low Power 
+ * @note  this macro is only called inside the function UTIL_LPM_EnterLowPower
+ *        and in a basic configuration shall be identcal to the macro 
+ *        UTIL_LPM_EXIT_CRITICAL_SECTION. In general, the request to enter the
+ *        low power mode is already done under a critical section and 
+ *        nesting it is useless (in specific implementations not even possible). 
+ *        So the users could define their own macro)
+ */
+#ifndef UTIL_LPM_ENTER_CRITICAL_SECTION_ELP
+  #define UTIL_LPM_ENTER_CRITICAL_SECTION_ELP( )    UTIL_LPM_ENTER_CRITICAL_SECTION( )
+#endif
+
+/**
+ * @brief macro used to exit the critical section when exiting Low Power mode
+ * @note  the behavior of the macro shall be symmetrical with the macro 
+ *        UTIL_LPM_ENTER_CRITICAL_SECTION_ELP
+ */
+#ifndef UTIL_LPM_EXIT_CRITICAL_SECTION_ELP
+  #define UTIL_LPM_EXIT_CRITICAL_SECTION_ELP( )     UTIL_LPM_EXIT_CRITICAL_SECTION( )
+#endif
+
+/**
+ * @}
+ */
+/* Private function prototypes -----------------------------------------------*/
+/* Private variables ---------------------------------------------------------*/
+/* Private typedef -----------------------------------------------------------*/
+/* Private defines -----------------------------------------------------------*/
+/** @defgroup TINY_LPM_Private_define TINY LPM private defines
+  * @{
+  */
+
+/**
+ * @brief value used to reset the LPM mode
+ */
+#define UTIL_LPM_NO_BIT_SET   (0UL)
+
+/**
+ * @}
+ */
+/* Private macros ------------------------------------------------------------*/
+/* Private variables ---------------------------------------------------------*/
+/** @defgroup TINY_LPM_Private_variables TINY LPM private variables
+  * @{
+  */
+
+/**
+ * @brief value used to represent the LPM state of stop mode
+ */
+static UTIL_LPM_bm_t StopModeDisable = UTIL_LPM_NO_BIT_SET;
+
+/**
+ * @brief value used to represent the LPM state of off mode
+ */
+static UTIL_LPM_bm_t OffModeDisable = UTIL_LPM_NO_BIT_SET;
+
+/**
+ * @}
+ */
+/* Global variables ----------------------------------------------------------*/
+/* Private function prototypes -----------------------------------------------*/
+/* Functions Definition ------------------------------------------------------*/
+
+/** @addtogroup TINY_LPM_Exported_function
+  * @{
+  */
+void UTIL_LPM_Init( void )
+{
+  StopModeDisable = UTIL_LPM_NO_BIT_SET;
+  OffModeDisable = UTIL_LPM_NO_BIT_SET;
+  UTIL_LPM_INIT_CRITICAL_SECTION( );
+}
+
+void UTIL_LPM_DeInit( void )
+{
+}
+
+void UTIL_LPM_SetStopMode( UTIL_LPM_bm_t lpm_id_bm, UTIL_LPM_State_t state )
+{
+  UTIL_LPM_ENTER_CRITICAL_SECTION( );
+  
+  switch( state )
+  {
+  case UTIL_LPM_DISABLE:
+    {
+      StopModeDisable |= lpm_id_bm;
+      break;
+    }
+  case UTIL_LPM_ENABLE:
+    {
+      StopModeDisable &= ( ~lpm_id_bm );
+      break;
+    }
+  default :
+    {
+      break;
+    }
+  }
+  
+  UTIL_LPM_EXIT_CRITICAL_SECTION( );
+}
+
+void UTIL_LPM_SetOffMode( UTIL_LPM_bm_t lpm_id_bm, UTIL_LPM_State_t state )
+{
+  UTIL_LPM_ENTER_CRITICAL_SECTION( );
+  
+  switch(state)
+  {
+  case UTIL_LPM_DISABLE:
+    {
+      OffModeDisable |= lpm_id_bm;
+      break;
+    }
+  case UTIL_LPM_ENABLE:
+    {
+      OffModeDisable &= ( ~lpm_id_bm );
+      break;
+    }
+  default :
+    {
+      break;
+    }
+  }
+  
+  UTIL_LPM_EXIT_CRITICAL_SECTION( );
+}
+
+UTIL_LPM_Mode_t UTIL_LPM_GetMode( void )
+{
+  UTIL_LPM_Mode_t mode_selected;
+
+  UTIL_LPM_ENTER_CRITICAL_SECTION( );
+
+  if( StopModeDisable != UTIL_LPM_NO_BIT_SET )
+  {
+    /**
+     * At least one user disallows Stop Mode
+     */
+    mode_selected = UTIL_LPM_SLEEPMODE;
+  }
+  else
+  {
+    if( OffModeDisable != UTIL_LPM_NO_BIT_SET )
+    {
+      /**
+       * At least one user disallows Off Mode
+       */
+      mode_selected = UTIL_LPM_STOPMODE;
+    }
+    else
+    {
+      mode_selected = UTIL_LPM_OFFMODE;
+    }
+  }
+
+  UTIL_LPM_EXIT_CRITICAL_SECTION( );
+
+  return mode_selected;
+}
+
+void UTIL_LPM_EnterLowPower( void )
+{
+  UTIL_LPM_ENTER_CRITICAL_SECTION_ELP( );
+
+  if( StopModeDisable != UTIL_LPM_NO_BIT_SET )
+  {
+    /**
+     * At least one user disallows Stop Mode
+     * SLEEP mode is required
+     */
+      UTIL_PowerDriver.EnterSleepMode( );
+      UTIL_PowerDriver.ExitSleepMode( );
+  }
+  else
+  { 
+    if( OffModeDisable != UTIL_LPM_NO_BIT_SET )
+    {
+      /**
+       * At least one user disallows Off Mode
+       * STOP mode is required
+       */
+        UTIL_PowerDriver.EnterStopMode( );
+        UTIL_PowerDriver.ExitStopMode( );
+    }
+    else
+    {
+      /**
+       * OFF mode is required
+       */
+      UTIL_PowerDriver.EnterOffMode( );
+      UTIL_PowerDriver.ExitOffMode( );
+    }
+  }
+  
+  UTIL_LPM_EXIT_CRITICAL_SECTION_ELP( );
+}
+
+/**
+ * @}
+ */
+
+/**
+ * @}
+ */