add eoe to ecat_slv

pull/52/head
Hans-Erik Floryd 2019-04-02 12:33:06 +02:00
parent 675d3516fb
commit aa811ae2f4
1 changed files with 17 additions and 1 deletions

View File

@ -197,10 +197,15 @@ void ecat_slv_worker (uint32_t event_mask)
ESC_coeprocess();
#if USE_FOE
ESC_foeprocess();
#endif
#if USE_EOE
ESC_eoeprocess();
#endif
ESC_xoeprocess();
}
#if USE_EOE
ESC_eoeprocess_tx();
#endif
/* Call emulated eeprom handler if set */
if (ESCvar.esc_hw_eep_handler != NULL)
{
@ -236,9 +241,15 @@ void ecat_slv_poll (void)
ESC_coeprocess();
#if USE_FOE
ESC_foeprocess();
#endif
#if USE_EOE
ESC_eoeprocess();
#endif
ESC_xoeprocess();
}
#if USE_EOE
ESC_eoeprocess_tx();
#endif
/* Call emulated eeprom handler if set */
if (ESCvar.esc_hw_eep_handler != NULL)
@ -282,6 +293,11 @@ void ecat_slv_init (esc_cfg_t * config)
FOE_init();
#endif
#if USE_EOE
/* Init EoE */
EOE_init();
#endif
/* reset ESC to init state */
ESC_ALstatus (ESCinit);
ESC_ALerror (ALERR_NONE);