#include "NvM.h"\r
#endif\r
\r
+\r
static uint32 internal_data_run_state_timeout = 0;\r
#if defined(USE_NVM)\r
static uint32 internal_data_go_off_one_state_timeout = 0;\r
static NvM_RequestResultType writeAllResult;\r
#endif\r
\r
+static uint32 internal_data_go_sleep_state_timeout = 0;\r
+\r
#ifdef CFG_ECUM_USE_SERVICE_COMPONENT\r
/** @req EcuM2749 */\r
static Rte_ModeType_EcuM_Mode currentMode;\r
\r
#if defined(USE_WDGM)\r
/* This seems strange, should be in FW instead */\r
- WdgM_SetMode(TODO_MODE);\r
+ WdgM_SetMode(internal_data.config->EcuMWdgMConfig->EcuMWdgMRunMode);\r
#endif\r
\r
#if defined(USE_COMM)\r
\r
\r
/**\r
- * GO SLEEP state ( in state ECUM_STATE_GO_SLEEP)\r
+ * Enter GO SLEEP state ( soon in state ECUM_STATE_GO_SLEEP)\r
*/\r
static inline void enter_go_sleep_mode(void){\r
EcuM_WakeupSourceType wakeupSource;\r
set_current_state(ECUM_STATE_GO_SLEEP);\r
+\r
EcuM_OnGoSleep();\r
\r
#if defined(USE_NVM)\r
NvM_WriteAll();\r
+\r
+ /* Start timer */\r
+ internal_data_go_sleep_state_timeout = internal_data.config->EcuMNvramWriteAllTimeout / ECUM_MAIN_FUNCTION_PERIOD;\r
+\r
wakeupSource = EcuM_GetPendingWakeupEvents();\r
#else\r
wakeupSource = EcuM_GetPendingWakeupEvents();\r
#endif\r
+}\r
+\r
+/**\r
+ In GO SLEEP state (in state ECUM_STATE_GO_SLEEP)\r
+ */\r
+static void in_state_goSleep( void ) {\r
+\r
+ /* We only wait for NvM_WriteAll() for so long */\r
+ if (internal_data_go_sleep_state_timeout){\r
+ internal_data_go_sleep_state_timeout--;\r
+ }\r
+\r
+ if( (internal_data_go_sleep_state_timeout == 0) ) {\r
+ /*\r
+ * We should go to sleep , enable source that should wake us\r
+ * */\r
+ uint32 cMask;\r
+ uint8 source;\r
+ const EcuM_SleepModeType *sleepModePtr;\r
+\r
+ /* Get the current sleep mode */\r
+\r
+ sleepModePtr = &internal_data.config->EcuMSleepModeConfig[internal_data.sleep_mode];\r
+\r
+ cMask = sleepModePtr->EcuMWakeupSourceMask;\r
+\r
+ /* Loop over the WKSOURCE for this sleep mode */\r
+ for (; cMask; cMask &= ~(1ul << source)) {\r
+ source = ilog2(cMask);\r
+ /* @req 3.1.5/ECUM2389 */\r
+ EcuM_EnableWakeupSources( 1<< source );\r
+\r
+#if defined(WDGM)\r
+ WdgM_SetMode(sleepModePtr->EcuMSleepModeWdgMMode);\r
+#endif\r
\r
+ /* Let no one else run */\r
+ GetResource(RES_SCHEDULER);\r
+ }\r
+\r
+ } else if( EcuM_GetPendingWakeupEvents() != 0 ) {\r
+ /* We have pending wakeup events, need to startup again */\r
+#if defined(USE_NVM)\r
+ NvM_CancelWriteAll();\r
+#endif\r
+ }\r
+}\r
\r
\r
+/**\r
+ * In "Sleep Sequence I" (in state ECUM_STATE_SLEEP)\r
+ */\r
+static void in_state_sleep ( void ) {\r
+ const EcuM_SleepModeType *sleepModePtr;\r
+ sleepModePtr = &internal_data.config->EcuMSleepModeConfig[internal_data.sleep_mode];\r
+\r
+ EcuM_GenerateRamHash();\r
+\r
+ Mcu_SetMode(sleepModePtr->EcuMSleepModeMcuMode);\r
+\r
+ /* @req 3.1.5/ECUM2863 */\r
+ if( EcuM_CheckRamHash() == 0) {\r
+#if defined(USE_DEM)\r
+ //\r
+ EcuM_ErrorHook(ECUM_E_RAM_CHECK_FAILED);\r
+#endif\r
+ }\r
+\r
+ set_current_state(ECUM_STATE_WAKEUP_ONE);\r
}\r
\r
static inline void enter_go_off_one_mode(void){\r
EcuM_OnExitRun(); /** @req EcuM2865 */\r
\r
#if defined(USE_WDGM)\r
- WdgM_SetMode(FIXME_MODE);\r
+ WdgM_SetMode(internal_data.config->EcuMWdgMConfig->EcuMWdgMPostRunMode);\r
#endif\r
\r
#if defined(USE_RTE) && defined(CFG_ECUM_USE_SERVICE_COMPONENT)\r
// Wait for the NVM job (NvmWriteAll) to terminate\r
NvM_GetErrorStatus(0, &writeAllResult);\r
if ((writeAllResult != NVM_REQ_PENDING) || (internal_data_go_off_one_state_timeout == 0)){\r
+\r
+#if defined(USE_WDGM)\r
+ WdgM_SetMode(internal_data.config->EcuMWdgMConfig->EcuMWdgMShutdownMode);\r
+#endif\r
ShutdownOS(E_OK);\r
}\r
#else\r
+\r
+#if defined(USE_WDGM)\r
+ WdgM_SetMode(internal_data.config->EcuMWdgMConfig->EcuMWdgMShutdownMode);\r
+#endif\r
ShutdownOS(E_OK);\r
#endif\r
}\r
\r
//----- MAIN -----------------------------------------------------------------------------------------------------------------\r
void EcuM_MainFunction(void){\r
+ EcuM_WakeupSourceType wMask;\r
+\r
VALIDATE_NO_RV(internal_data.initiated, ECUM_MAINFUNCTION_ID, ECUM_E_NOT_INITIATED);\r
\r
switch(internal_data.current_state){\r
in_state_goOffOne();\r
break;\r
case ECUM_STATE_GO_SLEEP:\r
- // TODO: Fill out\r
+ in_state_goSleep();\r
+ break;\r
+ case ECUM_STATE_SLEEP:\r
+ in_state_sleep();\r
+ break;\r
+ case ECUM_STATE_WAKEUP_ONE:\r
+ {\r
+ /* TODO: we must have a normal RUN mode.. can't find any\r
+ * in the A3.1.5 spec. */\r
+ Mcu_SetMode(MCU_MODE_NORMAL);\r
+\r
+#if defined(USE_WDGM)\r
+ WdgM_SetMode(internal_data.config->EcuMWdgMConfig->EcuMWdgMWakeupMode);\r
+#endif\r
+\r
+ wMask = EcuM_GetPendingWakeupEvents();\r
+\r
+ EcuM_DisableWakeupSources(wMask);\r
+\r
+ EcuM_AL_DriverRestart();\r
+\r
+ ReleaseResource(RES_SCHEDULER);\r
+\r
+ set_current_state(ECUM_STATE_WAKEUP_VALIDATION);\r
+\r
break;\r
+ }\r
+\r
+ case ECUM_STATE_WAKEUP_VALIDATION:\r
+ {\r
+ wMask = EcuM_GetPendingWakeupEvents();\r
+\r
+ EcuM_StartWakeupSources(wMask);\r
+\r
+ EcuM_CheckValidation( wMask );\r
+\r
+ // TODO:\r
+ // ComM_EcuM_WakeupIndication( network handle )\r
+\r
+ set_current_state(ECUM_STATE_WAKEUP_REACTION);\r
+ break;\r
+ }\r
+\r
+ case ECUM_STATE_WAKEUP_REACTION:\r
+ {\r
+ /*\r
+ * At this stage we want to know how to react to the wakeup, e.g. go\r
+ * back to RUN or SHUTDOWN, etc.\r
+ */\r
+ EcuM_WakeupReactionType wReaction;\r
+\r
+ wMask = EcuM_GetValidatedWakeupEvents();\r
+\r
+ /* TODO: We have skipped the TTII timer here */\r
+\r
+ /* If the wakeup mask here is != 0 we have a validated wakeup event ->\r
+ * go back to RUN */\r
+ wReaction = ( 0 == wMask ) ? ECUM_WKACT_SHUTDOWN : ECUM_WKACT_RUN;\r
+ wReaction = EcuM_OnWakeupReaction(wReaction);\r
+\r
+ if( wReaction == ECUM_WKACT_RUN) {\r
+ set_current_state(ECUM_STATE_WAKEUP_TWO);\r
+ } else {\r
+ /* From figure 28 it seems that we should go to SHUTDOWN/GO SLEEP) again from wakeup\r
+ * not going up to RUN/RUN II state again. */\r
+ set_current_state(ECUM_STATE_GO_SLEEP);\r
+ }\r
+ break;\r
+ }\r
+\r
+ case ECUM_STATE_WAKEUP_TWO:\r
+#if defined(USE_DEM)\r
+ Dem_Init();\r
+#endif\r
+ set_current_state(ECUM_STATE_RUN);\r
+ break;\r
+\r
default:\r
//TODO: Report error.\r
break;\r
projects / arc.git / blobdiff