Trinity Devboard PCB V1.0 Firmware. FreeRTOS is setup and the MCU reads IMU data over SPI fand Magnetometer data over I2C, each with a seperate task. Sensordata is then run though MadgwickAHRS and send over USB as serial packet data to use in trinity visualizer. Bare minimum functionality works and is replicated from the first prototype.
This commit is contained in:
@@ -0,0 +1,258 @@
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file stm32_lpm.c
|
||||
* @author MCD Application Team
|
||||
* @brief Low Power Manager
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* <h2><center>© 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( );
|
||||
}
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
Reference in New Issue
Block a user