fsm_slave_config.c File Reference

EtherCAT slave configuration state machine. More...

Go to the source code of this file.

Macros
#define	EC_DC_MAX_SYNC_DIFF_NS   10000
	Maximum clock difference (in ns) before going to SAFEOP. More...
#define	EC_DC_SYNC_WAIT_MS   5000
	Maximum time (in ms) to wait for clock discipline.
#define	EC_DC_START_OFFSET   100000000ULL
	Time offset (in ns), that is added to cyclic start time.

Functions
void	ec_fsm_slave_config_state_start (ec_fsm_slave_config_t *fsm)
	Slave configuration state: START. More...
void	ec_fsm_slave_config_state_init (ec_fsm_slave_config_t *fsm)
	Slave configuration state: INIT. More...
void	ec_fsm_slave_config_state_clear_fmmus (ec_fsm_slave_config_t *fsm)
	Slave configuration state: CLEAR FMMU. More...
void	ec_fsm_slave_config_state_clear_sync (ec_fsm_slave_config_t *fsm)
	Slave configuration state: CLEAR SYNC. More...
void	ec_fsm_slave_config_state_dc_clear_assign (ec_fsm_slave_config_t *fsm)
	Slave configuration state: CLEAR DC ASSIGN. More...
void	ec_fsm_slave_config_state_mbox_sync (ec_fsm_slave_config_t *fsm)
	Slave configuration state: SYNC. More...
void	ec_fsm_slave_config_state_assign_pdi (ec_fsm_slave_config_t *fsm)
	Slave configuration state: ASSIGN_PDI. More...
void	ec_fsm_slave_config_state_boot_preop (ec_fsm_slave_config_t *fsm)
	Slave configuration state: BOOT/PREOP. More...
void	ec_fsm_slave_config_state_assign_ethercat (ec_fsm_slave_config_t *fsm)
	Slave configuration state: ASSIGN_ETHERCAT. More...
void	ec_fsm_slave_config_state_sdo_conf (ec_fsm_slave_config_t *fsm)
	Slave configuration state: SDO_CONF. More...
void	ec_fsm_slave_config_state_soe_conf_preop (ec_fsm_slave_config_t *fsm)
	Slave configuration state: SOE_CONF. More...
void	ec_fsm_slave_config_state_watchdog_divider (ec_fsm_slave_config_t *fsm)
	Slave configuration state: WATCHDOG_DIVIDER. More...
void	ec_fsm_slave_config_state_watchdog (ec_fsm_slave_config_t *fsm)
	Slave configuration state: WATCHDOG. More...
void	ec_fsm_slave_config_state_pdo_sync (ec_fsm_slave_config_t *fsm)
	Configure PDO sync managers. More...
void	ec_fsm_slave_config_state_pdo_conf (ec_fsm_slave_config_t *fsm)
	Slave configuration state: PDO_CONF. More...
void	ec_fsm_slave_config_state_fmmu (ec_fsm_slave_config_t *fsm)
	Slave configuration state: FMMU. More...
void	ec_fsm_slave_config_state_dc_cycle (ec_fsm_slave_config_t *fsm)
	Slave configuration state: DC CYCLE. More...
void	ec_fsm_slave_config_state_dc_sync_check (ec_fsm_slave_config_t *fsm)
	Slave configuration state: DC SYNC CHECK. More...
void	ec_fsm_slave_config_state_dc_start (ec_fsm_slave_config_t *fsm)
	Slave configuration state: DC START. More...
void	ec_fsm_slave_config_state_dc_assign (ec_fsm_slave_config_t *fsm)
	Slave configuration state: DC ASSIGN. More...
void	ec_fsm_slave_config_state_safeop (ec_fsm_slave_config_t *fsm)
	Slave configuration state: SAFEOP. More...
void	ec_fsm_slave_config_state_soe_conf_safeop (ec_fsm_slave_config_t *fsm)
	Slave configuration state: SOE_CONF. More...
void	ec_fsm_slave_config_state_op (ec_fsm_slave_config_t *fsm)
	Slave configuration state: OP. More...
void	ec_fsm_slave_config_enter_init (ec_fsm_slave_config_t *fsm)
	Start state change to INIT. More...
void	ec_fsm_slave_config_enter_clear_sync (ec_fsm_slave_config_t *fsm)
	Clear the sync manager configurations. More...
void	ec_fsm_slave_config_enter_dc_clear_assign (ec_fsm_slave_config_t *fsm)
	Clear the DC assignment. More...
void	ec_fsm_slave_config_enter_mbox_sync (ec_fsm_slave_config_t *fsm)
	Check for mailbox sync managers to be configured. More...
void	ec_fsm_slave_config_enter_assign_pdi (ec_fsm_slave_config_t *fsm)
	Assign SII to PDI. More...
void	ec_fsm_slave_config_enter_boot_preop (ec_fsm_slave_config_t *fsm)
	Request PREOP state. More...
void	ec_fsm_slave_config_enter_sdo_conf (ec_fsm_slave_config_t *fsm)
	Check for SDO configurations to be applied. More...
void	ec_fsm_slave_config_enter_soe_conf_preop (ec_fsm_slave_config_t *fsm)
	Check for SoE configurations to be applied. More...
void	ec_fsm_slave_config_enter_pdo_conf (ec_fsm_slave_config_t *fsm)
	PDO_CONF entry function. More...
void	ec_fsm_slave_config_enter_watchdog_divider (ec_fsm_slave_config_t *fsm)
	WATCHDOG_DIVIDER entry function. More...
void	ec_fsm_slave_config_enter_watchdog (ec_fsm_slave_config_t *fsm)
	WATCHDOG entry function. More...
void	ec_fsm_slave_config_enter_pdo_sync (ec_fsm_slave_config_t *fsm)
	Check for PDO sync managers to be configured. More...
void	ec_fsm_slave_config_enter_fmmu (ec_fsm_slave_config_t *fsm)
	Check for FMMUs to be configured. More...
void	ec_fsm_slave_config_enter_dc_cycle (ec_fsm_slave_config_t *fsm)
	Check for DC to be configured. More...
void	ec_fsm_slave_config_enter_safeop (ec_fsm_slave_config_t *fsm)
	Request SAFEOP state. More...
void	ec_fsm_slave_config_enter_soe_conf_safeop (ec_fsm_slave_config_t *fsm)
	Check for SoE configurations to be applied in SAFEOP. More...
void	ec_fsm_slave_config_enter_op (ec_fsm_slave_config_t *fsm)
	Bring slave to OP. More...
void	ec_fsm_slave_config_state_end (ec_fsm_slave_config_t *fsm)
	State: END. More...
void	ec_fsm_slave_config_state_error (ec_fsm_slave_config_t *fsm)
	State: ERROR. More...
void	ec_fsm_slave_config_reconfigure (ec_fsm_slave_config_t *fsm)
	Reconfigure the slave starting at INIT. More...
void	ec_fsm_slave_config_init (ec_fsm_slave_config_t *fsm, ec_datagram_t *datagram, ec_fsm_change_t *fsm_change, ec_fsm_coe_t *fsm_coe, ec_fsm_soe_t *fsm_soe, ec_fsm_pdo_t *fsm_pdo)
	Constructor. More...
void	ec_fsm_slave_config_clear (ec_fsm_slave_config_t *fsm)
	Destructor. More...
void	ec_fsm_slave_config_start (ec_fsm_slave_config_t *fsm, ec_slave_t *slave)
	Start slave configuration state machine. More...
int	ec_fsm_slave_config_running (const ec_fsm_slave_config_t *fsm)
int	ec_fsm_slave_config_exec (ec_fsm_slave_config_t *fsm)
	Executes the current state of the state machine. More...
int	ec_fsm_slave_config_success (const ec_fsm_slave_config_t *fsm)

Detailed Description

EtherCAT slave configuration state machine.

Definition in file fsm_slave_config.c.

Macro Definition Documentation

#define EC_DC_MAX_SYNC_DIFF_NS   10000

Maximum clock difference (in ns) before going to SAFEOP.

Wait for DC time difference to drop under this absolute value before requesting SAFEOP.

Definition at line 52 of file fsm_slave_config.c.

Function Documentation

void ec_fsm_slave_config_state_start

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: START.

Parameters

fsm	slave state machine

Definition at line 219 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_init

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: INIT.

Parameters

fsm	slave state machine

Definition at line 244 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_clear_fmmus

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: CLEAR FMMU.

Parameters

fsm	slave state machine

Definition at line 281 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_clear_sync

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: CLEAR SYNC.

Parameters

fsm	slave state machine

Definition at line 340 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_dc_clear_assign

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: CLEAR DC ASSIGN.

Parameters

fsm	slave state machine

Definition at line 396 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_mbox_sync

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: SYNC.

Todo:

Timeout for response.

Parameters

fsm	slave state machine

Definition at line 557 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_assign_pdi

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: ASSIGN_PDI.

Parameters

fsm	slave state machine

Definition at line 648 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_boot_preop

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: BOOT/PREOP.

Parameters

fsm	slave state machine

Definition at line 701 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_assign_ethercat

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: ASSIGN_ETHERCAT.

Parameters

fsm	slave state machine

Definition at line 774 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_sdo_conf

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: SDO_CONF.

Parameters

fsm	slave state machine

Definition at line 843 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_soe_conf_preop

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: SOE_CONF.

Parameters

fsm	slave state machine

Definition at line 916 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_watchdog_divider

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: WATCHDOG_DIVIDER.

Parameters

fsm	slave state machine

Definition at line 1025 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_watchdog

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: WATCHDOG.

Parameters

fsm	slave state machine

Definition at line 1084 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_pdo_sync

(

ec_fsm_slave_config_t *

fsm

)

Configure PDO sync managers.

Parameters

fsm	slave state machine

Definition at line 1183 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_pdo_conf

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: PDO_CONF.

Parameters

fsm	slave state machine

Definition at line 974 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_fmmu

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: FMMU.

Parameters

fsm	slave state machine

Definition at line 1270 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_dc_cycle

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: DC CYCLE.

Parameters

fsm	slave state machine

Definition at line 1340 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_dc_sync_check

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: DC SYNC CHECK.

Parameters

fsm	slave state machine

Definition at line 1383 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_dc_start

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: DC START.

Parameters

fsm	slave state machine

Definition at line 1484 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_dc_assign

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: DC ASSIGN.

Parameters

fsm	slave state machine

Definition at line 1529 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_safeop

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: SAFEOP.

Parameters

fsm	slave state machine

Definition at line 1574 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_soe_conf_safeop

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: SOE_CONF.

Parameters

fsm	slave state machine

Definition at line 1640 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_op

(

ec_fsm_slave_config_t *

fsm

)

Slave configuration state: OP.

Parameters

fsm	slave state machine

Definition at line 1698 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_init

(

ec_fsm_slave_config_t *

fsm

)

Start state change to INIT.

Parameters

fsm	slave state machine

Definition at line 231 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_clear_sync

(

ec_fsm_slave_config_t *

fsm

)

Clear the sync manager configurations.

Parameters

fsm	slave state machine

Definition at line 311 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_dc_clear_assign

(

ec_fsm_slave_config_t *

fsm

)

Clear the DC assignment.

Parameters

fsm	slave state machine

Definition at line 372 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_mbox_sync

(

ec_fsm_slave_config_t *

fsm

)

Check for mailbox sync managers to be configured.

Parameters

fsm	slave state machine

Definition at line 425 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_assign_pdi

(

ec_fsm_slave_config_t *

fsm

)

Assign SII to PDI.

Parameters

fsm	slave state machine

Definition at line 624 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_boot_preop

(

ec_fsm_slave_config_t *

fsm

)

Request PREOP state.

Parameters

fsm	slave state machine

Definition at line 680 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_sdo_conf

(

ec_fsm_slave_config_t *

fsm

)

Check for SDO configurations to be applied.

Parameters

fsm	slave state machine

Definition at line 812 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_soe_conf_preop

(

ec_fsm_slave_config_t *

fsm

)

Check for SoE configurations to be applied.

Parameters

fsm	slave state machine

Definition at line 882 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_pdo_conf

(

ec_fsm_slave_config_t *

fsm

)

PDO_CONF entry function.

Parameters

fsm	slave state machine

Definition at line 960 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_watchdog_divider

(

ec_fsm_slave_config_t *

fsm

)

WATCHDOG_DIVIDER entry function.

Parameters

fsm	slave state machine

Definition at line 1000 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_watchdog

(

ec_fsm_slave_config_t *

fsm

)

WATCHDOG entry function.

Parameters

fsm	slave state machine

Definition at line 1057 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_pdo_sync

(

ec_fsm_slave_config_t *

fsm

)

Check for PDO sync managers to be configured.

Parameters

fsm	slave state machine

Definition at line 1115 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_fmmu

(

ec_fsm_slave_config_t *

fsm

)

Check for FMMUs to be configured.

Parameters

fsm	slave state machine

Definition at line 1216 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_dc_cycle

(

ec_fsm_slave_config_t *

fsm

)

Check for DC to be configured.

Parameters

fsm	slave state machine

Definition at line 1302 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_safeop

(

ec_fsm_slave_config_t *

fsm

)

Request SAFEOP state.

Parameters

fsm	slave state machine

Definition at line 1561 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_soe_conf_safeop

(

ec_fsm_slave_config_t *

fsm

)

Check for SoE configurations to be applied in SAFEOP.

Parameters

fsm	slave state machine

Definition at line 1606 of file fsm_slave_config.c.

void ec_fsm_slave_config_enter_op

(

ec_fsm_slave_config_t *

fsm

)

Bring slave to OP.

Parameters

fsm	slave state machine

Definition at line 1684 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_end

(

ec_fsm_slave_config_t *

fsm

)

State: END.

Parameters

fsm	slave state machine

Definition at line 1750 of file fsm_slave_config.c.

void ec_fsm_slave_config_state_error

(

ec_fsm_slave_config_t *

fsm

)

State: ERROR.

Parameters

fsm	slave state machine

Definition at line 1740 of file fsm_slave_config.c.

void ec_fsm_slave_config_reconfigure

(

ec_fsm_slave_config_t *

fsm

)

Reconfigure the slave starting at INIT.

Parameters

fsm	slave state machine

Definition at line 1724 of file fsm_slave_config.c.

void ec_fsm_slave_config_init	(	ec_fsm_slave_config_t *	fsm,
		ec_datagram_t *	datagram,
		ec_fsm_change_t *	fsm_change,
		ec_fsm_coe_t *	fsm_coe,
		ec_fsm_soe_t *	fsm_soe,
		ec_fsm_pdo_t *	fsm_pdo
	)

Constructor.

Parameters

fsm	slave state machine
datagram	datagram structure to use
fsm_change	State change state machine to use.
fsm_coe	CoE state machine to use.
fsm_soe	SoE state machine to use.
fsm_pdo	PDO configuration state machine to use.

Definition at line 121 of file fsm_slave_config.c.

void ec_fsm_slave_config_clear

(

ec_fsm_slave_config_t *

fsm

)

Destructor.

Parameters

fsm	slave state machine

Definition at line 144 of file fsm_slave_config.c.

void ec_fsm_slave_config_start	(	ec_fsm_slave_config_t *	fsm,
		ec_slave_t *	slave
	)

Start slave configuration state machine.

Parameters

fsm	slave state machine
slave	slave to configure

Definition at line 156 of file fsm_slave_config.c.

int ec_fsm_slave_config_running

(

const ec_fsm_slave_config_t *

fsm

)

Returns

false, if state machine has terminated

Parameters

fsm	slave state machine

Definition at line 170 of file fsm_slave_config.c.

int ec_fsm_slave_config_exec

(

ec_fsm_slave_config_t *

fsm

)

Executes the current state of the state machine.

If the state machine's datagram is not sent or received yet, the execution of the state machine is delayed to the next cycle.

Returns

false, if state machine has terminated

Parameters

fsm	slave state machine

Definition at line 187 of file fsm_slave_config.c.

int ec_fsm_slave_config_success

(

const ec_fsm_slave_config_t *

fsm

)

Returns

true, if the state machine terminated gracefully

Parameters

fsm	slave state machine

Definition at line 206 of file fsm_slave_config.c.