etherlabmaster: master/fsm_slave_config.c@fec951a0a654 (annotated)

830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1	/******************************************************************************
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	3	* $Id$
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
1326 ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	5	* Copyright (C) 2006-2008 Florian Pose, Ingenieurgemeinschaft IgH
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	6	*
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	7	* This file is part of the IgH EtherCAT Master.
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	8	*
1326 ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	9	* The IgH EtherCAT Master is free software; you can redistribute it and/or
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	10	* modify it under the terms of the GNU General Public License version 2, as
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	11	* published by the Free Software Foundation.
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	12	*
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	13	* The IgH EtherCAT Master is distributed in the hope that it will be useful,
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	16	* Public License for more details.
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	17	*
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	18	* You should have received a copy of the GNU General Public License along
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1318 diff changeset	19	* with the IgH EtherCAT Master; if not, write to the Free Software
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	20	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	21	*
1363 11c0b2caa253 Improved and added license headers. Florian Pose <fp@igh-essen.com> parents: 1347 diff changeset	22	* ---
11c0b2caa253 Improved and added license headers. Florian Pose <fp@igh-essen.com> parents: 1347 diff changeset	23	*
11c0b2caa253 Improved and added license headers. Florian Pose <fp@igh-essen.com> parents: 1347 diff changeset	24	* The license mentioned above concerns the source code only. Using the
11c0b2caa253 Improved and added license headers. Florian Pose <fp@igh-essen.com> parents: 1347 diff changeset	25	* EtherCAT technology and brand is only permitted in compliance with the
11c0b2caa253 Improved and added license headers. Florian Pose <fp@igh-essen.com> parents: 1347 diff changeset	26	* industrial property and similar rights of Beckhoff Automation GmbH.
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	27	*
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	28	*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	29
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	30	/** \file
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	31	*
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	32	* EtherCAT slave configuration state machine.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	33	*/
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	34
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	35	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	36
1436 08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	37	#include <asm/div64.h>
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	38
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	39	#include "globals.h"
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	40	#include "master.h"
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	41	#include "mailbox.h"
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	42	#include "slave_config.h"
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	43	#include "fsm_slave_config.h"
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	44
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	45	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	46
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	47	void ec_fsm_slave_config_state_start(ec_fsm_slave_config_t *);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	48	void ec_fsm_slave_config_state_init(ec_fsm_slave_config_t *);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	49	void ec_fsm_slave_config_state_clear_fmmus(ec_fsm_slave_config_t *);
1342 a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	50	void ec_fsm_slave_config_state_clear_sync(ec_fsm_slave_config_t *);
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	51	void ec_fsm_slave_config_state_dc_clear_assign(ec_fsm_slave_config_t *);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	52	void ec_fsm_slave_config_state_dc_read_offset(ec_fsm_slave_config_t *);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	53	void ec_fsm_slave_config_state_dc_write_offset(ec_fsm_slave_config_t *);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	54	void ec_fsm_slave_config_state_mbox_sync(ec_fsm_slave_config_t *);
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	55	void ec_fsm_slave_config_state_boot_preop(ec_fsm_slave_config_t *);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	56	void ec_fsm_slave_config_state_sdo_conf(ec_fsm_slave_config_t *);
1844 b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	57	void ec_fsm_slave_config_state_soe_conf(ec_fsm_slave_config_t *);
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	58	void ec_fsm_slave_config_state_watchdog_divider(ec_fsm_slave_config_t *);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	59	void ec_fsm_slave_config_state_watchdog(ec_fsm_slave_config_t *);
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	60	void ec_fsm_slave_config_state_pdo_sync(ec_fsm_slave_config_t *);
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	61	void ec_fsm_slave_config_state_pdo_conf(ec_fsm_slave_config_t *);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	62	void ec_fsm_slave_config_state_fmmu(ec_fsm_slave_config_t *);
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	63	void ec_fsm_slave_config_state_dc_cycle(ec_fsm_slave_config_t *);
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	64	void ec_fsm_slave_config_state_dc_start(ec_fsm_slave_config_t *);
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	65	void ec_fsm_slave_config_state_dc_assign(ec_fsm_slave_config_t *);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	66	void ec_fsm_slave_config_state_safeop(ec_fsm_slave_config_t *);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	67	void ec_fsm_slave_config_state_op(ec_fsm_slave_config_t *);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	68
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	69	void ec_fsm_slave_config_enter_init(ec_fsm_slave_config_t *);
1342 a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	70	void ec_fsm_slave_config_enter_clear_sync(ec_fsm_slave_config_t *);
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	71	void ec_fsm_slave_config_enter_dc_clear_assign(ec_fsm_slave_config_t *);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	72	void ec_fsm_slave_config_enter_mbox_sync(ec_fsm_slave_config_t *);
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	73	void ec_fsm_slave_config_enter_boot_preop(ec_fsm_slave_config_t *);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	74	void ec_fsm_slave_config_enter_sdo_conf(ec_fsm_slave_config_t *);
1844 b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	75	void ec_fsm_slave_config_enter_soe_conf(ec_fsm_slave_config_t *);
1180 846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	76	void ec_fsm_slave_config_enter_pdo_conf(ec_fsm_slave_config_t *);
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	77	void ec_fsm_slave_config_enter_watchdog_divider(ec_fsm_slave_config_t *);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	78	void ec_fsm_slave_config_enter_watchdog(ec_fsm_slave_config_t *);
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	79	void ec_fsm_slave_config_enter_pdo_sync(ec_fsm_slave_config_t *);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	80	void ec_fsm_slave_config_enter_fmmu(ec_fsm_slave_config_t *);
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	81	void ec_fsm_slave_config_enter_dc_cycle(ec_fsm_slave_config_t *);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	82	void ec_fsm_slave_config_enter_safeop(ec_fsm_slave_config_t *);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	83
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	84	void ec_fsm_slave_config_state_end(ec_fsm_slave_config_t *);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	85	void ec_fsm_slave_config_state_error(ec_fsm_slave_config_t *);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	86
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	87	void ec_fsm_slave_config_reconfigure(ec_fsm_slave_config_t *);
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	88
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	89	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	90
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	91	/** Constructor.
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	92	*/
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	93	void ec_fsm_slave_config_init(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	94	ec_fsm_slave_config_t fsm, /< slave state machine /
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	95	ec_datagram_t datagram, /< datagram structure to use /
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	96	ec_fsm_change_t fsm_change, /< State change state machine to use. /
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	97	ec_fsm_coe_t fsm_coe, /< CoE state machine to use. /
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	98	ec_fsm_pdo_t fsm_pdo /< PDO configuration state machine to use. /
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	99	)
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	100	{
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	101	ec_sdo_request_init(&fsm->request_copy);
1849 0a660edc7180 Fixed segfault - Initialize SoE request properly. Florian Pose <fp@igh-essen.com> parents: 1844 diff changeset	102	ec_soe_request_init(&fsm->soe_request_copy);
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	103
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	104	fsm->datagram = datagram;
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	105	fsm->fsm_change = fsm_change;
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	106	fsm->fsm_coe = fsm_coe;
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	107	fsm->fsm_pdo = fsm_pdo;
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	108	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	109
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	110	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	111
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	112	/** Destructor.
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	113	*/
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	114	void ec_fsm_slave_config_clear(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	115	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	116	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	117	{
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	118	ec_sdo_request_clear(&fsm->request_copy);
1844 b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	119	ec_soe_request_clear(&fsm->soe_request_copy);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	120	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	121
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	122	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	123
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	124	/** Start slave configuration state machine.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	125	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	126	void ec_fsm_slave_config_start(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	127	ec_fsm_slave_config_t fsm, /< slave state machine /
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	128	ec_slave_t slave /< slave to configure /
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	129	)
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	130	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	131	fsm->slave = slave;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	132	fsm->state = ec_fsm_slave_config_state_start;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	133	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	134
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	135	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	136
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	137	/**
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	138	* \return false, if state machine has terminated
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	139	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	140	int ec_fsm_slave_config_running(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	141	const ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	142	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	143	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	144	return fsm->state != ec_fsm_slave_config_state_end
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	145	&& fsm->state != ec_fsm_slave_config_state_error;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	146	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	147
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	148	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	149
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	150	/** Executes the current state of the state machine.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	151	*
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	152	* If the state machine's datagram is not sent or received yet, the execution
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	153	* of the state machine is delayed to the next cycle.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	154	*
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	155	* \return false, if state machine has terminated
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	156	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	157	int ec_fsm_slave_config_exec(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	158	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	159	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	160	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	161	if (fsm->datagram->state == EC_DATAGRAM_SENT
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	162	\|\| fsm->datagram->state == EC_DATAGRAM_QUEUED) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	163	// datagram was not sent or received yet.
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	164	return ec_fsm_slave_config_running(fsm);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	165	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	166
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	167	fsm->state(fsm);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	168	return ec_fsm_slave_config_running(fsm);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	169	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	170
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	171	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	172
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	173	/**
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	174	* \return true, if the state machine terminated gracefully
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	175	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	176	int ec_fsm_slave_config_success(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	177	const ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	178	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	179	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	180	return fsm->state == ec_fsm_slave_config_state_end;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	181	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	182
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	183	/******************************************************************************
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	184	* Slave configuration state machine
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	185	*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	186
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	187	/** Slave configuration state: START.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	188	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	189	void ec_fsm_slave_config_state_start(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	190	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	191	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	192	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	193	if (fsm->slave->master->debug_level) {
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	194	EC_DBG("Configuring slave %u...\n", fsm->slave->ring_position);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	195	}
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	196
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	197	ec_fsm_slave_config_enter_init(fsm);
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	198	}
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	199
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	200	/*****************************************************************************/
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	201
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	202	/** Start state change to INIT.
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	203	*/
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	204	void ec_fsm_slave_config_enter_init(
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	205	ec_fsm_slave_config_t fsm /< slave state machine /
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	206	)
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	207	{
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	208	ec_fsm_change_start(fsm->fsm_change, fsm->slave, EC_SLAVE_STATE_INIT);
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	209	ec_fsm_change_exec(fsm->fsm_change);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	210	fsm->state = ec_fsm_slave_config_state_init;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	211	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	212
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	213	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	214
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	215	/** Slave configuration state: INIT.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	216	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	217	void ec_fsm_slave_config_state_init(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	218	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	219	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	220	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	221	ec_master_t *master = fsm->slave->master;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	222	ec_slave_t *slave = fsm->slave;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	223	ec_datagram_t *datagram = fsm->datagram;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	224
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	225	if (ec_fsm_change_exec(fsm->fsm_change)) return;
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	226
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	227	if (!ec_fsm_change_success(fsm->fsm_change)) {
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	228	if (!fsm->fsm_change->spontaneous_change)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	229	slave->error_flag = 1;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	230	fsm->state = ec_fsm_slave_config_state_error;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	231	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	232	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	233
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	234	if (master->debug_level) {
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	235	EC_DBG("Slave %u is now in INIT.\n", slave->ring_position);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	236	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	237
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	238	if (!slave->base_fmmu_count) { // skip FMMU configuration
1342 a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	239	ec_fsm_slave_config_enter_clear_sync(fsm);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	240	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	241	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	242
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	243	if (master->debug_level)
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	244	EC_DBG("Clearing FMMU configurations of slave %u...\n",
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	245	slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	246
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	247	// clear FMMU configurations
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	248	ec_datagram_fpwr(datagram, slave->station_address,
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	249	0x0600, EC_FMMU_PAGE_SIZE * slave->base_fmmu_count);
1225 4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1180 diff changeset	250	ec_datagram_zero(datagram);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	251	fsm->retries = EC_FSM_RETRIES;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	252	fsm->state = ec_fsm_slave_config_state_clear_fmmus;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	253	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	254
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	255	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	256
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	257	/** Slave configuration state: CLEAR FMMU.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	258	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	259	void ec_fsm_slave_config_state_clear_fmmus(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	260	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	261	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	262	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	263	ec_datagram_t *datagram = fsm->datagram;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	264
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	265	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	266	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	267
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	268	if (datagram->state != EC_DATAGRAM_RECEIVED) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	269	fsm->state = ec_fsm_slave_config_state_error;
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	270	EC_ERR("Failed receive FMMU clearing datagram for slave %u.\n",
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	271	fsm->slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	272	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	273	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	274
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	275	if (datagram->working_counter != 1) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	276	fsm->slave->error_flag = 1;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	277	fsm->state = ec_fsm_slave_config_state_error;
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	278	EC_ERR("Failed to clear FMMUs of slave %u: ",
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	279	fsm->slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	280	ec_datagram_print_wc_error(datagram);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	281	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	282	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	283
1342 a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	284	ec_fsm_slave_config_enter_clear_sync(fsm);
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	285	}
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	286
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	287	/*****************************************************************************/
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	288
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	289	/** Clear the sync manager configurations.
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	290	*/
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	291	void ec_fsm_slave_config_enter_clear_sync(
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	292	ec_fsm_slave_config_t fsm /< slave state machine /
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	293	)
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	294	{
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	295	ec_slave_t *slave = fsm->slave;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	296	ec_datagram_t *datagram = fsm->datagram;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	297	size_t sync_size;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	298
1471 2ec173081b7f Fixed mailbox usage for slaves that do not provide sync manager Florian Pose <fp@igh-essen.com> parents: 1458 diff changeset	299	if (!slave->base_sync_count) {
1404 b7ea043d5081 Minor changes. Florian Pose <fp@igh-essen.com> parents: 1396 diff changeset	300	// no sync managers
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	301	ec_fsm_slave_config_enter_dc_clear_assign(fsm);
1342 a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	302	return;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	303	}
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	304
1344 e5756d4ed12c Debug message. Florian Pose <fp@igh-essen.com> parents: 1342 diff changeset	305	if (slave->master->debug_level)
e5756d4ed12c Debug message. Florian Pose <fp@igh-essen.com> parents: 1342 diff changeset	306	EC_DBG("Clearing sync manager configurations of slave %u...\n",
e5756d4ed12c Debug message. Florian Pose <fp@igh-essen.com> parents: 1342 diff changeset	307	slave->ring_position);
e5756d4ed12c Debug message. Florian Pose <fp@igh-essen.com> parents: 1342 diff changeset	308
1471 2ec173081b7f Fixed mailbox usage for slaves that do not provide sync manager Florian Pose <fp@igh-essen.com> parents: 1458 diff changeset	309	sync_size = EC_SYNC_PAGE_SIZE * slave->base_sync_count;
1342 a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	310
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	311	// clear sync manager configurations
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	312	ec_datagram_fpwr(datagram, slave->station_address, 0x0800, sync_size);
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	313	memset(datagram->data, 0x00, sync_size);
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	314	fsm->retries = EC_FSM_RETRIES;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	315	fsm->state = ec_fsm_slave_config_state_clear_sync;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	316	}
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	317
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	318	/*****************************************************************************/
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	319
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	320	/** Slave configuration state: CLEAR SYNC.
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	321	*/
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	322	void ec_fsm_slave_config_state_clear_sync(
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	323	ec_fsm_slave_config_t fsm /< slave state machine /
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	324	)
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	325	{
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	326	ec_datagram_t *datagram = fsm->datagram;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	327
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	328	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	329	return;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	330
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	331	if (datagram->state != EC_DATAGRAM_RECEIVED) {
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	332	fsm->state = ec_fsm_slave_config_state_error;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	333	EC_ERR("Failed receive sync manager clearing datagram"
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	334	" for slave %u.\n", fsm->slave->ring_position);
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	335	return;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	336	}
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	337
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	338	if (datagram->working_counter != 1) {
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	339	fsm->slave->error_flag = 1;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	340	fsm->state = ec_fsm_slave_config_state_error;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	341	EC_ERR("Failed to clear sync manager configurations of slave %u: ",
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	342	fsm->slave->ring_position);
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	343	ec_datagram_print_wc_error(datagram);
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	344	return;
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	345	}
a72b9b370277 Clear sync managers before configuration. Florian Pose <fp@igh-essen.com> parents: 1338 diff changeset	346
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	347	ec_fsm_slave_config_enter_dc_clear_assign(fsm);
1406 8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	348	}
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	349
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	350	/*****************************************************************************/
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	351
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	352	/** Clear the DC assignment.
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	353	*/
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	354	void ec_fsm_slave_config_enter_dc_clear_assign(
1406 8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	355	ec_fsm_slave_config_t fsm /< slave state machine /
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	356	)
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	357	{
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	358	ec_slave_t *slave = fsm->slave;
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	359	ec_datagram_t *datagram = fsm->datagram;
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	360
1419 8fc38c37d86e Determine type of DC implementation (full or delay meas. only); update scan FSM graph. Florian Pose <fp@igh-essen.com> parents: 1412 diff changeset	361	if (!slave->base_dc_supported \|\| !slave->has_dc_system_time) {
1406 8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	362	ec_fsm_slave_config_enter_mbox_sync(fsm);
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	363	return;
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	364	}
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	365
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	366	if (slave->master->debug_level)
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	367	EC_DBG("Clearing DC assignment of slave %u...\n",
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	368	slave->ring_position);
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	369
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	370	ec_datagram_fpwr(datagram, slave->station_address, 0x0980, 2);
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	371	ec_datagram_zero(datagram);
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	372	fsm->retries = EC_FSM_RETRIES;
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	373	fsm->state = ec_fsm_slave_config_state_dc_clear_assign;
1406 8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	374	}
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	375
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	376	/*****************************************************************************/
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	377
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	378	/** Slave configuration state: CLEAR DC ASSIGN.
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	379	*/
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	380	void ec_fsm_slave_config_state_dc_clear_assign(
1406 8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	381	ec_fsm_slave_config_t fsm /< slave state machine /
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	382	)
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	383	{
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	384	ec_datagram_t *datagram = fsm->datagram;
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	385
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	386	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	387	return;
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	388
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	389	if (datagram->state != EC_DATAGRAM_RECEIVED) {
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	390	fsm->state = ec_fsm_slave_config_state_error;
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	391	EC_ERR("Failed receive DC assignment clearing datagram"
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	392	" for slave %u.\n", fsm->slave->ring_position);
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	393	return;
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	394	}
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	395
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	396	if (fsm->slave->master->debug_level && datagram->working_counter != 1) {
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	397	// clearing the DC assignment does not succeed on simple slaves
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	398	EC_DBG("Failed to clear DC assignment of slave %u: ",
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	399	fsm->slave->ring_position);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	400	ec_datagram_print_wc_error(datagram);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	401	}
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	402
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	403	// read DC system time and system time offset
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	404	ec_datagram_fprd(fsm->datagram, fsm->slave->station_address, 0x0910, 24);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	405	fsm->retries = EC_FSM_RETRIES;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	406	fsm->state = ec_fsm_slave_config_state_dc_read_offset;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	407	}
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	408
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	409	/*****************************************************************************/
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	410
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	411	/** Slave configuration state: DC READ OFFSET.
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	412	*/
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	413	void ec_fsm_slave_config_state_dc_read_offset(
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	414	ec_fsm_slave_config_t fsm /< slave state machine /
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	415	)
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	416	{
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	417	ec_datagram_t *datagram = fsm->datagram;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	418	ec_slave_t *slave = fsm->slave;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	419	u64 system_time, old_offset, new_offset;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	420
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	421	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	422	return;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	423
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	424	if (datagram->state != EC_DATAGRAM_RECEIVED) {
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	425	fsm->state = ec_fsm_slave_config_state_error;
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	426	EC_ERR("Failed to receive DC times datagram for slave %u: ",
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	427	slave->ring_position);
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	428	ec_datagram_print_state(datagram);
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	429	return;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	430	}
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	431
1406 8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	432	if (datagram->working_counter != 1) {
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	433	slave->error_flag = 1;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	434	fsm->state = ec_fsm_slave_config_state_error;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	435	EC_ERR("Failed to get DC times of slave %u: ",
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	436	slave->ring_position);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	437	ec_datagram_print_wc_error(datagram);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	438	return;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	439	}
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	440
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	441	system_time = EC_READ_U64(datagram->data);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	442	old_offset = EC_READ_U64(datagram->data + 16);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	443	new_offset = slave->master->app_time - system_time + old_offset;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	444
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	445	if (slave->master->debug_level)
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	446	EC_DBG("Slave %u: DC system_time=%llu old_offset=%llu, "
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	447	"app_time=%llu, new_offset=%llu\n",
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	448	slave->ring_position, system_time, old_offset,
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	449	slave->master->app_time, new_offset);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	450
1430 97ab86a9b1d7 Set system time transmission delay during config. Florian Pose <fp@igh-essen.com> parents: 1419 diff changeset	451	// set DC system time offset and transmission delay
97ab86a9b1d7 Set system time transmission delay during config. Florian Pose <fp@igh-essen.com> parents: 1419 diff changeset	452	ec_datagram_fpwr(datagram, slave->station_address, 0x0920, 12);
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	453	EC_WRITE_U64(datagram->data, new_offset);
1507 68e89abadd19 Removed unwanted tabulators. Florian Pose <fp@igh-essen.com> parents: 1491 diff changeset	454	EC_WRITE_U32(datagram->data + 8, slave->transmission_delay);
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	455	fsm->retries = EC_FSM_RETRIES;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	456	fsm->state = ec_fsm_slave_config_state_dc_write_offset;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	457	}
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	458
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	459	/*****************************************************************************/
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	460
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	461	/** Slave configuration state: DC WRITE OFFSET.
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	462	*/
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	463	void ec_fsm_slave_config_state_dc_write_offset(
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	464	ec_fsm_slave_config_t fsm /< slave state machine /
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	465	)
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	466	{
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	467	ec_datagram_t *datagram = fsm->datagram;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	468	ec_slave_t *slave = fsm->slave;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	469
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	470	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	471	return;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	472
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	473	if (datagram->state != EC_DATAGRAM_RECEIVED) {
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	474	fsm->state = ec_fsm_slave_config_state_error;
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	475	EC_ERR("Failed to receive DC system time offset datagram for"
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	476	" slave %u: ", slave->ring_position);
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	477	ec_datagram_print_state(datagram);
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	478	return;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	479	}
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	480
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	481	if (datagram->working_counter != 1) {
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	482	slave->error_flag = 1;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	483	fsm->state = ec_fsm_slave_config_state_error;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	484	EC_ERR("Failed to set DC system time offset of slave %u: ",
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	485	slave->ring_position);
1406 8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	486	ec_datagram_print_wc_error(datagram);
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	487	return;
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	488	}
8686c5b3d14b Clear DC assignment after going to INIT. Florian Pose <fp@igh-essen.com> parents: 1404 diff changeset	489
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	490	ec_fsm_slave_config_enter_mbox_sync(fsm);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	491	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	492
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	493	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	494
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	495	/** Check for mailbox sync managers to be configured.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	496	*/
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	497	void ec_fsm_slave_config_enter_mbox_sync(
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	498	ec_fsm_slave_config_t fsm /< slave state machine /
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	499	)
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	500	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	501	ec_master_t *master = fsm->slave->master;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	502	ec_slave_t *slave = fsm->slave;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	503	ec_datagram_t *datagram = fsm->datagram;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	504	unsigned int i;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	505
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	506	// slave is now in INIT
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	507	if (slave->current_state == slave->requested_state) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	508	fsm->state = ec_fsm_slave_config_state_end; // successful
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	509	if (master->debug_level) {
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	510	EC_DBG("Finished configuration of slave %u.\n",
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	511	slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	512	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	513	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	514	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	515
834 0791aac03180 Separated SII data from slave. Florian Pose <fp@igh-essen.com> parents: 830 diff changeset	516	if (!slave->sii.mailbox_protocols) {
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	517	// no mailbox protocols supported
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	518	if (master->debug_level)
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	519	EC_DBG("Slave %u does not support mailbox communication.\n",
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	520	slave->ring_position);
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	521	ec_fsm_slave_config_enter_boot_preop(fsm);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	522	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	523	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	524
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	525	if (master->debug_level) {
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	526	EC_DBG("Configuring mailbox sync managers of slave %u.\n",
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	527	slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	528	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	529
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	530	if (slave->requested_state == EC_SLAVE_STATE_BOOT) {
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	531	ec_sync_t sync;
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	532
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	533	ec_datagram_fpwr(datagram, slave->station_address, 0x0800,
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	534	EC_SYNC_PAGE_SIZE * 2);
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	535	memset(datagram->data, 0x00, EC_SYNC_PAGE_SIZE * 2);
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	536
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	537	ec_sync_init(&sync, slave);
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	538	sync.physical_start_address = slave->sii.boot_rx_mailbox_offset;
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	539	sync.control_register = 0x26;
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	540	sync.enable = 1;
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	541	ec_sync_page(&sync, 0, slave->sii.boot_rx_mailbox_size,
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	542	EC_DIR_INVALID, // use default direction
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	543	datagram->data);
1338 eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	544	slave->configured_rx_mailbox_offset =
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	545	slave->sii.boot_rx_mailbox_offset;
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	546	slave->configured_rx_mailbox_size =
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	547	slave->sii.boot_rx_mailbox_size;
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	548
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	549	ec_sync_init(&sync, slave);
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	550	sync.physical_start_address = slave->sii.boot_tx_mailbox_offset;
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	551	sync.control_register = 0x22;
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	552	sync.enable = 1;
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	553	ec_sync_page(&sync, 1, slave->sii.boot_tx_mailbox_size,
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	554	EC_DIR_INVALID, // use default direction
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	555	datagram->data + EC_SYNC_PAGE_SIZE);
1338 eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	556	slave->configured_tx_mailbox_offset =
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	557	slave->sii.boot_tx_mailbox_offset;
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	558	slave->configured_tx_mailbox_size =
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	559	slave->sii.boot_tx_mailbox_size;
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	560
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	561	} else if (slave->sii.sync_count >= 2) { // mailbox configuration provided
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	562	ec_datagram_fpwr(datagram, slave->station_address, 0x0800,
834 0791aac03180 Separated SII data from slave. Florian Pose <fp@igh-essen.com> parents: 830 diff changeset	563	EC_SYNC_PAGE_SIZE * slave->sii.sync_count);
1225 4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1180 diff changeset	564	ec_datagram_zero(datagram);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	565
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	566	for (i = 0; i < 2; i++) {
1055 2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	567	ec_sync_page(&slave->sii.syncs[i], i,
2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	568	slave->sii.syncs[i].default_length,
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	569	NULL, // use default sync manager configuration
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	570	datagram->data + EC_SYNC_PAGE_SIZE * i);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	571	}
1338 eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	572
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	573	slave->configured_rx_mailbox_offset =
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	574	slave->sii.syncs[0].physical_start_address;
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	575	slave->configured_rx_mailbox_size =
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	576	slave->sii.syncs[0].default_length;
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	577	slave->configured_tx_mailbox_offset =
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	578	slave->sii.syncs[1].physical_start_address;
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	579	slave->configured_tx_mailbox_size =
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	580	slave->sii.syncs[1].default_length;
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	581	} else { // no mailbox sync manager configurations provided
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	582	ec_sync_t sync;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	583
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	584	if (master->debug_level)
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	585	EC_DBG("Slave %u does not provide"
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	586	" mailbox sync manager configurations.\n",
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	587	slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	588
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	589	ec_datagram_fpwr(datagram, slave->station_address, 0x0800,
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	590	EC_SYNC_PAGE_SIZE * 2);
1225 4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1180 diff changeset	591	ec_datagram_zero(datagram);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	592
1055 2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	593	ec_sync_init(&sync, slave);
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	594	sync.physical_start_address = slave->sii.std_rx_mailbox_offset;
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	595	sync.control_register = 0x26;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	596	sync.enable = 1;
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	597	ec_sync_page(&sync, 0, slave->sii.std_rx_mailbox_size,
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	598	NULL, // use default sync manager configuration
1055 2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	599	datagram->data);
1338 eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	600	slave->configured_rx_mailbox_offset =
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	601	slave->sii.std_rx_mailbox_offset;
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	602	slave->configured_rx_mailbox_size =
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	603	slave->sii.std_rx_mailbox_size;
1055 2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	604
2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	605	ec_sync_init(&sync, slave);
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	606	sync.physical_start_address = slave->sii.std_tx_mailbox_offset;
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	607	sync.control_register = 0x22;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	608	sync.enable = 1;
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	609	ec_sync_page(&sync, 1, slave->sii.std_tx_mailbox_size,
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	610	NULL, // use default sync manager configuration
1055 2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	611	datagram->data + EC_SYNC_PAGE_SIZE);
1338 eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	612	slave->configured_tx_mailbox_offset =
1471 2ec173081b7f Fixed mailbox usage for slaves that do not provide sync manager Florian Pose <fp@igh-essen.com> parents: 1458 diff changeset	613	slave->sii.std_tx_mailbox_offset;
1338 eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size\|offset) members of slave. Florian Pose <fp@igh-essen.com> parents: 1337 diff changeset	614	slave->configured_tx_mailbox_size =
1471 2ec173081b7f Fixed mailbox usage for slaves that do not provide sync manager Florian Pose <fp@igh-essen.com> parents: 1458 diff changeset	615	slave->sii.std_tx_mailbox_size;
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	616	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	617
1347 41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	618	fsm->take_time = 1;
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	619
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	620	fsm->retries = EC_FSM_RETRIES;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	621	fsm->state = ec_fsm_slave_config_state_mbox_sync;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	622	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	623
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	624	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	625
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	626	/** Slave configuration state: SYNC.
1345 b715e719eeea TODO. Florian Pose <fp@igh-essen.com> parents: 1344 diff changeset	627	*
b715e719eeea TODO. Florian Pose <fp@igh-essen.com> parents: 1344 diff changeset	628	* \todo Timeout for response.
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	629	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	630	void ec_fsm_slave_config_state_mbox_sync(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	631	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	632	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	633	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	634	ec_datagram_t *datagram = fsm->datagram;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	635	ec_slave_t *slave = fsm->slave;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	636
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	637	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	638	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	639
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	640	if (datagram->state != EC_DATAGRAM_RECEIVED) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	641	fsm->state = ec_fsm_slave_config_state_error;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	642	EC_ERR("Failed to receive sync manager configuration datagram for"
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	643	" slave %u: ", slave->ring_position);
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	644	ec_datagram_print_state(datagram);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	645	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	646	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	647
1347 41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	648	if (fsm->take_time) {
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	649	fsm->take_time = 0;
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	650	fsm->jiffies_start = datagram->jiffies_sent;
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	651	}
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	652
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	653	/* Because the sync manager configurations are cleared during the last
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	654	* cycle, some slaves do not immediately respond to the mailbox sync
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	655	* manager configuration datagram. Therefore, resend the datagram for
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	656	* a certain time, if the slave does not respond.
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	657	*/
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	658	if (datagram->working_counter == 0) {
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	659	unsigned long diff = datagram->jiffies_received - fsm->jiffies_start;
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	660
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	661	if (diff >= HZ) {
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	662	slave->error_flag = 1;
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	663	fsm->state = ec_fsm_slave_config_state_error;
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	664	EC_ERR("Timeout while configuring mailbox sync managers of"
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	665	" slave %u.\n", slave->ring_position);
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	666	return;
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	667	}
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	668	else if (slave->master->debug_level) {
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	669	EC_DBG("Resending after %u ms...\n",
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	670	(unsigned int) diff * 1000 / HZ);
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	671	}
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	672
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	673	// send configuration datagram again
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	674	fsm->retries = EC_FSM_RETRIES;
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	675	return;
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	676	}
41360ffdcb14 Allow the slave to not respond to the mailbox sync manager configuration Florian Pose <fp@igh-essen.com> parents: 1345 diff changeset	677	else if (datagram->working_counter != 1) {
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	678	slave->error_flag = 1;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	679	fsm->state = ec_fsm_slave_config_state_error;
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	680	EC_ERR("Failed to set sync managers of slave %u: ",
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	681	slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	682	ec_datagram_print_wc_error(datagram);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	683	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	684	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	685
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	686	ec_fsm_slave_config_enter_boot_preop(fsm);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	687	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	688
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	689	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	690
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	691	/** Request PREOP state.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	692	*/
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	693	void ec_fsm_slave_config_enter_boot_preop(
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	694	ec_fsm_slave_config_t fsm /< slave state machine /
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	695	)
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	696	{
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	697	fsm->state = ec_fsm_slave_config_state_boot_preop;
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	698
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	699	if (fsm->slave->requested_state != EC_SLAVE_STATE_BOOT) {
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	700	ec_fsm_change_start(fsm->fsm_change, fsm->slave, EC_SLAVE_STATE_PREOP);
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	701	} else { // BOOT
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	702	ec_fsm_change_start(fsm->fsm_change, fsm->slave, EC_SLAVE_STATE_BOOT);
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	703	}
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	704
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	705	ec_fsm_change_exec(fsm->fsm_change); // execute immediately
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	706	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	707
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	708	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	709
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	710	/** Slave configuration state: BOOT/PREOP.
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	711	*/
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	712	void ec_fsm_slave_config_state_boot_preop(
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	713	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	714	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	715	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	716	ec_slave_t *slave = fsm->slave;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	717	ec_master_t *master = fsm->slave->master;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	718
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	719	if (ec_fsm_change_exec(fsm->fsm_change)) return;
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	720
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	721	if (!ec_fsm_change_success(fsm->fsm_change)) {
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	722	if (!fsm->fsm_change->spontaneous_change)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	723	slave->error_flag = 1;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	724	fsm->state = ec_fsm_slave_config_state_error;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	725	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	726	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	727
1404 b7ea043d5081 Minor changes. Florian Pose <fp@igh-essen.com> parents: 1396 diff changeset	728	// slave is now in BOOT or PREOP
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	729	slave->jiffies_preop = fsm->datagram->jiffies_received;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	730
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	731	if (master->debug_level) {
1337 0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	732	EC_DBG("Slave %u is now in %s.\n", slave->ring_position,
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	733	slave->requested_state != EC_SLAVE_STATE_BOOT
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT. Florian Pose <fp@igh-essen.com> parents: 1327 diff changeset	734	? "PREOP" : "BOOT");
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	735	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	736
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	737	if (slave->current_state == slave->requested_state) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	738	fsm->state = ec_fsm_slave_config_state_end; // successful
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	739	if (master->debug_level) {
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	740	EC_DBG("Finished configuration of slave %u.\n",
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	741	slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	742	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	743	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	744	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	745
1491 40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	746	ec_fsm_slave_config_enter_sdo_conf(fsm);
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	747	}
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	748
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	749	/*****************************************************************************/
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	750
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	751	/** Check for SDO configurations to be applied.
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	752	*/
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	753	void ec_fsm_slave_config_enter_sdo_conf(
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	754	ec_fsm_slave_config_t fsm /< slave state machine /
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	755	)
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	756	{
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	757	ec_slave_t *slave = fsm->slave;
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	758
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	759	if (!slave->config) {
1491 40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	760	ec_fsm_slave_config_enter_pdo_sync(fsm);
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	761	return;
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	762	}
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	763
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	764	// No CoE configuration to be applied?
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	765	if (list_empty(&slave->config->sdo_configs)) { // skip SDO configuration
1844 b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	766	ec_fsm_slave_config_enter_soe_conf(fsm);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	767	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	768	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	769
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	770	// start SDO configuration
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	771	fsm->state = ec_fsm_slave_config_state_sdo_conf;
854 f4f53be425ac Removed ec_sdodata_t; CoE state machines work on ec_sdo_request_t. Florian Pose <fp@igh-essen.com> parents: 834 diff changeset	772	fsm->request = list_entry(fsm->slave->config->sdo_configs.next,
f4f53be425ac Removed ec_sdodata_t; CoE state machines work on ec_sdo_request_t. Florian Pose <fp@igh-essen.com> parents: 834 diff changeset	773	ec_sdo_request_t, list);
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	774	ec_sdo_request_copy(&fsm->request_copy, fsm->request);
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	775	ecrt_sdo_request_write(&fsm->request_copy);
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	776	ec_fsm_coe_transfer(fsm->fsm_coe, fsm->slave, &fsm->request_copy);
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	777	ec_fsm_coe_exec(fsm->fsm_coe); // execute immediately
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	778	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	779
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	780	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	781
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	782	/** Slave configuration state: SDO_CONF.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	783	*/
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	784	void ec_fsm_slave_config_state_sdo_conf(
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	785	ec_fsm_slave_config_t fsm /< slave state machine /
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	786	)
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	787	{
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	788	if (ec_fsm_coe_exec(fsm->fsm_coe)) return;
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	789
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	790	if (!ec_fsm_coe_success(fsm->fsm_coe)) {
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	791	EC_ERR("SDO configuration failed for slave %u.\n",
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	792	fsm->slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	793	fsm->slave->error_flag = 1;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	794	fsm->state = ec_fsm_slave_config_state_error;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	795	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	796	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	797
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	798	if (!fsm->slave->config) { // config removed in the meantime
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	799	ec_fsm_slave_config_reconfigure(fsm);
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	800	return;
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	801	}
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	802
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	803	// Another SDO to configure?
854 f4f53be425ac Removed ec_sdodata_t; CoE state machines work on ec_sdo_request_t. Florian Pose <fp@igh-essen.com> parents: 834 diff changeset	804	if (fsm->request->list.next != &fsm->slave->config->sdo_configs) {
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	805	fsm->request = list_entry(fsm->request->list.next,
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	806	ec_sdo_request_t, list);
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	807	ec_sdo_request_copy(&fsm->request_copy, fsm->request);
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	808	ecrt_sdo_request_write(&fsm->request_copy);
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	809	ec_fsm_coe_transfer(fsm->fsm_coe, fsm->slave, &fsm->request_copy);
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	810	ec_fsm_coe_exec(fsm->fsm_coe); // execute immediately
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	811	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	812	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	813
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	814	// All SDOs are now configured.
1844 b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	815	ec_fsm_slave_config_enter_soe_conf(fsm);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	816	}
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	817
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	818	/*****************************************************************************/
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	819
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	820	/** Check for SoE configurations to be applied.
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	821	*/
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	822	void ec_fsm_slave_config_enter_soe_conf(
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	823	ec_fsm_slave_config_t fsm /< slave state machine /
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	824	)
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	825	{
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	826	ec_slave_t *slave = fsm->slave;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	827	ec_fsm_soe_t *fsm_soe = &slave->fsm.fsm_soe;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	828
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	829	if (!slave->config) {
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	830	ec_fsm_slave_config_enter_pdo_sync(fsm);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	831	return;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	832	}
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	833
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	834	// No SoE configuration to be applied?
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	835	if (list_empty(&slave->config->soe_configs)) { // skip configuration
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	836	ec_fsm_slave_config_enter_pdo_conf(fsm);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	837	return;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	838	}
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	839
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	840	// start SoE configuration
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	841	fsm->state = ec_fsm_slave_config_state_soe_conf;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	842	fsm->soe_request = list_entry(fsm->slave->config->soe_configs.next,
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	843	ec_soe_request_t, list);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	844	ec_soe_request_copy(&fsm->soe_request_copy, fsm->soe_request);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	845	ec_soe_request_write(&fsm->soe_request_copy);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	846	ec_fsm_soe_transfer(fsm_soe, fsm->slave, &fsm->soe_request_copy);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	847	ec_fsm_soe_exec(fsm_soe); // execute immediately
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	848	}
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	849
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	850	/*****************************************************************************/
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	851
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	852	/** Slave configuration state: SOE_CONF.
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	853	*/
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	854	void ec_fsm_slave_config_state_soe_conf(
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	855	ec_fsm_slave_config_t fsm /< slave state machine /
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	856	)
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	857	{
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	858	ec_slave_t *slave = fsm->slave;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	859	ec_fsm_soe_t *fsm_soe = &slave->fsm.fsm_soe;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	860
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	861	if (ec_fsm_soe_exec(fsm_soe)) {
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	862	return;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	863	}
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	864
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	865	if (!ec_fsm_soe_success(fsm_soe)) {
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	866	EC_ERR("SoE configuration failed for slave %u.\n",
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	867	fsm->slave->ring_position);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	868	fsm->slave->error_flag = 1;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	869	fsm->state = ec_fsm_slave_config_state_error;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	870	return;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	871	}
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	872
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	873	if (!fsm->slave->config) { // config removed in the meantime
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	874	ec_fsm_slave_config_reconfigure(fsm);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	875	return;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	876	}
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	877
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	878	// Another IDN to configure?
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	879	if (fsm->soe_request->list.next != &fsm->slave->config->soe_configs) {
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	880	fsm->soe_request = list_entry(fsm->soe_request->list.next,
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	881	ec_soe_request_t, list);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	882	ec_soe_request_copy(&fsm->soe_request_copy, fsm->soe_request);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	883	ec_soe_request_write(&fsm->soe_request_copy);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	884	ec_fsm_soe_transfer(fsm_soe, fsm->slave, &fsm->soe_request_copy);
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	885	ec_fsm_soe_exec(fsm_soe); // execute immediately
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	886	return;
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	887	}
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	888
b6bd88d4806b Added ecrt_slave_config_idn() method to store SoE IDN configurations. Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	889	// All SDOs are now configured.
1180 846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	890	ec_fsm_slave_config_enter_pdo_conf(fsm);
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	891	}
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	892
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	893	/*****************************************************************************/
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	894
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	895	/** PDO_CONF entry function.
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	896	*/
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	897	void ec_fsm_slave_config_enter_pdo_conf(
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	898	ec_fsm_slave_config_t fsm /< slave state machine /
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	899	)
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	900	{
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	901	// Start configuring PDOs
1180 846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	902	ec_fsm_pdo_start_configuration(fsm->fsm_pdo, fsm->slave);
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	903	fsm->state = ec_fsm_slave_config_state_pdo_conf;
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	904	fsm->state(fsm); // execute immediately
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	905	}
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	906
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	907	/*****************************************************************************/
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	908
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	909	/** Slave configuration state: PDO_CONF.
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	910	*/
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	911	void ec_fsm_slave_config_state_pdo_conf(
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	912	ec_fsm_slave_config_t fsm /< slave state machine /
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	913	)
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	914	{
1507 68e89abadd19 Removed unwanted tabulators. Florian Pose <fp@igh-essen.com> parents: 1491 diff changeset	915	// TODO check for config here
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	916
1180 846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	917	if (ec_fsm_pdo_exec(fsm->fsm_pdo))
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	918	return;
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	919
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	920	if (!fsm->slave->config) { // config removed in the meantime
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	921	ec_fsm_slave_config_reconfigure(fsm);
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	922	return;
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	923	}
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	924
1180 846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	925	if (!ec_fsm_pdo_success(fsm->fsm_pdo)) {
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	926	EC_WARN("PDO configuration failed on slave %u.\n",
1180 846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	927	fsm->slave->ring_position);
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	928	}
846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	929
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	930	ec_fsm_slave_config_enter_watchdog_divider(fsm);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	931	}
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	932
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	933	/*****************************************************************************/
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	934
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	935	/** WATCHDOG_DIVIDER entry function.
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	936	*/
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	937	void ec_fsm_slave_config_enter_watchdog_divider(
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	938	ec_fsm_slave_config_t fsm /< slave state machine /
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	939	)
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	940	{
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	941	ec_slave_t *slave = fsm->slave;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	942	ec_datagram_t *datagram = fsm->datagram;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	943	ec_master_t *master = slave->master;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	944	ec_slave_config_t *config = slave->config;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	945
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	946	if (config && config->watchdog_divider) {
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	947	if (master->debug_level)
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	948	EC_DBG("Setting watchdog divider to %u.\n",
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	949	config->watchdog_divider);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	950
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	951	ec_datagram_fpwr(datagram, slave->station_address, 0x0400, 2);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	952	EC_WRITE_U16(datagram->data, config->watchdog_divider);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	953	fsm->retries = EC_FSM_RETRIES;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	954	fsm->state = ec_fsm_slave_config_state_watchdog_divider;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	955	} else {
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	956	ec_fsm_slave_config_enter_watchdog(fsm);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	957	}
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	958	}
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	959
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	960	/*****************************************************************************/
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	961
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	962	/** Slave configuration state: WATCHDOG_DIVIDER.
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	963	*/
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	964	void ec_fsm_slave_config_state_watchdog_divider(
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	965	ec_fsm_slave_config_t fsm /< slave state machine /
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	966	)
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	967	{
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	968	ec_datagram_t *datagram = fsm->datagram;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	969	ec_slave_t *slave = fsm->slave;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	970
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	971	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	972	return;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	973
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	974	if (datagram->state != EC_DATAGRAM_RECEIVED) {
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	975	fsm->state = ec_fsm_slave_config_state_error;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	976	EC_ERR("Failed to receive watchdog divider configuration datagram for"
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	977	" slave %u: ", slave->ring_position);
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	978	ec_datagram_print_state(datagram);
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	979	return;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	980	}
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	981
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	982	if (datagram->working_counter != 1) {
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	983	slave->error_flag = 1;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	984	EC_WARN("Failed to set watchdog divider of slave %u: ",
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	985	slave->ring_position);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	986	ec_datagram_print_wc_error(datagram);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	987	return;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	988	}
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	989
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	990	ec_fsm_slave_config_enter_watchdog(fsm);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	991	}
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	992
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	993	/*****************************************************************************/
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	994
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	995	/** WATCHDOG entry function
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	996	*/
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	997	void ec_fsm_slave_config_enter_watchdog(
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	998	ec_fsm_slave_config_t fsm /< slave state machine /
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	999	)
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1000	{
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1001	ec_datagram_t *datagram = fsm->datagram;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1002	ec_slave_t *slave = fsm->slave;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1003	ec_slave_config_t *config = slave->config;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1004
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1005	if (config && config->watchdog_intervals) {
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1006	if (slave->master->debug_level)
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1007	EC_DBG("Setting process data watchdog intervals to %u.\n",
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1008	config->watchdog_intervals);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1009
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1010	ec_datagram_fpwr(datagram, slave->station_address, 0x0420, 2);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1011	EC_WRITE_U16(datagram->data, config->watchdog_intervals);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1012
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1013	fsm->retries = EC_FSM_RETRIES;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1014	fsm->state = ec_fsm_slave_config_state_watchdog;
1520 09cf61d61af0 Fixed setting watchdog intervals. Florian Pose <fp@igh-essen.com> parents: 1509 diff changeset	1015	} else {
09cf61d61af0 Fixed setting watchdog intervals. Florian Pose <fp@igh-essen.com> parents: 1509 diff changeset	1016	ec_fsm_slave_config_enter_pdo_sync(fsm);
09cf61d61af0 Fixed setting watchdog intervals. Florian Pose <fp@igh-essen.com> parents: 1509 diff changeset	1017	}
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1018	}
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1019
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1020	/*****************************************************************************/
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1021
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1022	/** Slave configuration state: WATCHDOG.
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1023	*/
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1024
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1025	void ec_fsm_slave_config_state_watchdog(
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1026	ec_fsm_slave_config_t fsm /< slave state machine /
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1027	)
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1028	{
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1029	ec_datagram_t *datagram = fsm->datagram;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1030	ec_slave_t *slave = fsm->slave;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1031
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1032	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1033	return;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1034
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1035	if (datagram->state != EC_DATAGRAM_RECEIVED) {
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1036	fsm->state = ec_fsm_slave_config_state_error;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1037	EC_ERR("Failed to receive sync manager watchdog configuration "
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1038	"datagram for slave %u: ", slave->ring_position);
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1039	ec_datagram_print_state(datagram);
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1040	return;
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1041	}
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1042
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1043	if (datagram->working_counter != 1) {
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1044	EC_WARN("Failed to set process data watchdog intervals of slave %u: ",
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1045	slave->ring_position);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1046	ec_datagram_print_wc_error(datagram);
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1047	}
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1048
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1049	ec_fsm_slave_config_enter_pdo_sync(fsm);
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1050	}
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1051
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1052	/*****************************************************************************/
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1053
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	1054	/** Check for PDO sync managers to be configured.
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1055	*/
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1056	void ec_fsm_slave_config_enter_pdo_sync(
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1057	ec_fsm_slave_config_t fsm /< slave state machine /
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1058	)
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1059	{
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1060	ec_slave_t *slave = fsm->slave;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1061	ec_datagram_t *datagram = fsm->datagram;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1062	unsigned int i, offset, num_pdo_syncs;
1055 2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	1063	uint8_t sync_index;
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1064	const ec_sync_t *sync;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1065	uint16_t size;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1066
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1067	if (slave->sii.mailbox_protocols) {
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1068	offset = 2; // slave has mailboxes
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1069	} else {
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1070	offset = 0;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1071	}
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1072
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1073	if (slave->sii.sync_count <= offset) {
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	1074	// no PDO sync managers to configure
1180 846907b8cc4b Configure Pdos before configuring the Pdo sync managers, Florian Pose <fp@igh-essen.com> parents: 1174 diff changeset	1075	ec_fsm_slave_config_enter_fmmu(fsm);
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1076	return;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1077	}
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1078
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1079	num_pdo_syncs = slave->sii.sync_count - offset;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1080
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1081	// configure sync managers for process data
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1082	ec_datagram_fpwr(datagram, slave->station_address,
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1083	0x0800 + EC_SYNC_PAGE_SIZE * offset,
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1084	EC_SYNC_PAGE_SIZE * num_pdo_syncs);
1225 4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1180 diff changeset	1085	ec_datagram_zero(datagram);
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1086
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1087	for (i = 0; i < num_pdo_syncs; i++) {
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1088	const ec_sync_config_t *sync_config;
1055 2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	1089	sync_index = i + offset;
2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	1090	sync = &slave->sii.syncs[sync_index];
1491 40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	1091
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	1092	if (slave->config) {
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	1093	sync_config = &slave->config->sync_configs[sync_index];
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	1094	size = ec_pdo_list_total_size(&sync_config->pdos);
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	1095	} else {
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1096	sync_config = NULL;
1491 40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	1097	size = sync->default_length;
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	1098	}
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	1099
1509 a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1100	ec_sync_page(sync, sync_index, size, sync_config,
a864688e7de5 Added watchdog configuration via application interface (thanks to J. Mohre). Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	1101	datagram->data + EC_SYNC_PAGE_SIZE * i);
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1102	}
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1103
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1104	fsm->retries = EC_FSM_RETRIES;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1105	fsm->state = ec_fsm_slave_config_state_pdo_sync;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1106	}
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1107
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1108	/*****************************************************************************/
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1109
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	1110	/** Configure PDO sync managers.
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1111	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1112	void ec_fsm_slave_config_state_pdo_sync(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1113	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1114	)
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1115	{
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1116	ec_datagram_t *datagram = fsm->datagram;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1117	ec_slave_t *slave = fsm->slave;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1118
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1119	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1120	return;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1121
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1122	if (datagram->state != EC_DATAGRAM_RECEIVED) {
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1123	fsm->state = ec_fsm_slave_config_state_error;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1124	EC_ERR("Failed to receive process data sync manager configuration"
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1125	" datagram for slave %u: ", slave->ring_position);
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1126	ec_datagram_print_state(datagram);
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1127	return;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1128	}
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1129
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1130	if (datagram->working_counter != 1) {
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1131	slave->error_flag = 1;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1132	fsm->state = ec_fsm_slave_config_state_error;
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	1133	EC_ERR("Failed to set process data sync managers of slave %u: ",
888 f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1134	slave->ring_position);
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1135	ec_datagram_print_wc_error(datagram);
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1136	return;
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1137	}
f0db19108bba Moved Pdo sync manager configuration before Pdo assignment in slave Florian Pose <fp@igh-essen.com> parents: 879 diff changeset	1138
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1139	ec_fsm_slave_config_enter_fmmu(fsm);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1140	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1141
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1142	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1143
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1144	/** Check for FMMUs to be configured.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1145	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1146	void ec_fsm_slave_config_enter_fmmu(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1147	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1148	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1149	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1150	ec_slave_t *slave = fsm->slave;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1151	ec_datagram_t *datagram = fsm->datagram;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1152	unsigned int i;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1153	const ec_fmmu_config_t *fmmu;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1154	const ec_sync_t *sync;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1155
1491 40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	1156	if (!slave->config) {
40529f2f60bd Configure PDO sync managers even if no configuration has been applied. Florian Pose <fp@igh-essen.com> parents: 1471 diff changeset	1157	ec_fsm_slave_config_enter_safeop(fsm);
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1158	return;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1159	}
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1160
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1161	if (slave->base_fmmu_count < slave->config->used_fmmus) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1162	slave->error_flag = 1;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1163	fsm->state = ec_fsm_slave_config_state_error;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1164	EC_ERR("Slave %u has less FMMUs (%u) than requested (%u).\n",
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1165	slave->ring_position, slave->base_fmmu_count,
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1166	slave->config->used_fmmus);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1167	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1168	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1169
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1170	if (!slave->base_fmmu_count) { // skip FMMU configuration
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1171	ec_fsm_slave_config_enter_dc_cycle(fsm);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1172	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1173	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1174
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1175	// configure FMMUs
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1176	ec_datagram_fpwr(datagram, slave->station_address,
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1177	0x0600, EC_FMMU_PAGE_SIZE * slave->base_fmmu_count);
1225 4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1180 diff changeset	1178	ec_datagram_zero(datagram);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1179	for (i = 0; i < slave->config->used_fmmus; i++) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1180	fmmu = &slave->config->fmmu_configs[i];
1055 2be8918682fa Store sync manager configurations in ec_slave_config_t instead of Pdo Florian Pose <fp@igh-essen.com> parents: 1053 diff changeset	1181	if (!(sync = ec_slave_get_sync(slave, fmmu->sync_index))) {
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1182	slave->error_flag = 1;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1183	fsm->state = ec_fsm_slave_config_state_error;
1327 4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	1184	EC_ERR("Failed to determine PDO sync manager for FMMU on slave"
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1185	" %u!\n", slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1186	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1187	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1188	ec_fmmu_config_page(fmmu, sync,
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1189	datagram->data + EC_FMMU_PAGE_SIZE * i);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1190	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1191
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1192	fsm->retries = EC_FSM_RETRIES;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1193	fsm->state = ec_fsm_slave_config_state_fmmu;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1194	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1195
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1196	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1197
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1198	/** Slave configuration state: FMMU.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1199	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1200	void ec_fsm_slave_config_state_fmmu(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1201	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1202	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1203	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1204	ec_datagram_t *datagram = fsm->datagram;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1205	ec_slave_t *slave = fsm->slave;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1206
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1207	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1208	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1209
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1210	if (datagram->state != EC_DATAGRAM_RECEIVED) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1211	fsm->state = ec_fsm_slave_config_state_error;
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1212	EC_ERR("Failed to receive FMMUs datagram for slave %u: ",
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1213	slave->ring_position);
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1214	ec_datagram_print_state(datagram);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1215	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1216	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1217
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1218	if (datagram->working_counter != 1) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1219	slave->error_flag = 1;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1220	fsm->state = ec_fsm_slave_config_state_error;
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	1221	EC_ERR("Failed to set FMMUs of slave %u: ",
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1222	slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1223	ec_datagram_print_wc_error(datagram);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1224	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1225	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1226
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1227	ec_fsm_slave_config_enter_dc_cycle(fsm);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1228	}
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1229
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1230	/*****************************************************************************/
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1231
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1232	/** Check for DC to be configured.
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1233	*/
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1234	void ec_fsm_slave_config_enter_dc_cycle(
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1235	ec_fsm_slave_config_t fsm /< slave state machine /
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1236	)
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1237	{
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1238	ec_datagram_t *datagram = fsm->datagram;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1239	ec_slave_t *slave = fsm->slave;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1240	ec_slave_config_t *config = slave->config;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1241
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1242	if (!config) { // config removed in the meantime
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1243	ec_fsm_slave_config_reconfigure(fsm);
1396 9d04cc08f40f DC sync reference clock to application time. TBC... Florian Pose <fp@igh-essen.com> parents: 1392 diff changeset	1244	return;
9d04cc08f40f DC sync reference clock to application time. TBC... Florian Pose <fp@igh-essen.com> parents: 1392 diff changeset	1245	}
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1246
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1247	if (config->dc_assign_activate) {
1419 8fc38c37d86e Determine type of DC implementation (full or delay meas. only); update scan FSM graph. Florian Pose <fp@igh-essen.com> parents: 1412 diff changeset	1248	if (!slave->base_dc_supported \|\| !slave->has_dc_system_time) {
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1249	EC_WARN("Slave %u seems not to support distributed clocks!\n",
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1250	slave->ring_position);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1251	}
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1252
1458 bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1253	if (slave->master->debug_level)
bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1254	EC_DBG("Slave %u: Setting DC cycle times to %u / %u.\n",
bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1255	slave->ring_position,
bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1256	config->dc_sync[0].cycle_time,
bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1257	config->dc_sync[1].cycle_time);
bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1258
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1259	// set DC cycle times
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1260	ec_datagram_fpwr(datagram, slave->station_address, 0x09A0, 8);
1438 1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1261	EC_WRITE_U32(datagram->data, config->dc_sync[0].cycle_time);
1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1262	EC_WRITE_U32(datagram->data + 4, config->dc_sync[1].cycle_time);
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1263	fsm->retries = EC_FSM_RETRIES;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1264	fsm->state = ec_fsm_slave_config_state_dc_cycle;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1265	} else {
1404 b7ea043d5081 Minor changes. Florian Pose <fp@igh-essen.com> parents: 1396 diff changeset	1266	// DC are unused
1396 9d04cc08f40f DC sync reference clock to application time. TBC... Florian Pose <fp@igh-essen.com> parents: 1392 diff changeset	1267	ec_fsm_slave_config_enter_safeop(fsm);
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1268	}
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1269	}
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1270
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1271	/*****************************************************************************/
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1272
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1273	/** Slave configuration state: DC CYCLE.
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1274	*/
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1275	void ec_fsm_slave_config_state_dc_cycle(
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1276	ec_fsm_slave_config_t fsm /< slave state machine /
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1277	)
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1278	{
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1279	ec_datagram_t *datagram = fsm->datagram;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1280	ec_slave_t *slave = fsm->slave;
1436 08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1281	ec_master_t *master = slave->master;
1412 8f7bbbd3b7ac DC shift time working. Florian Pose <fp@igh-essen.com> parents: 1407 diff changeset	1282	ec_slave_config_t *config = slave->config;
1438 1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1283	ec_sync_signal_t *sync0 = &config->dc_sync[0];
1396 9d04cc08f40f DC sync reference clock to application time. TBC... Florian Pose <fp@igh-essen.com> parents: 1392 diff changeset	1284	u64 start_time;
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1285
1412 8f7bbbd3b7ac DC shift time working. Florian Pose <fp@igh-essen.com> parents: 1407 diff changeset	1286	if (!config) { // config removed in the meantime
8f7bbbd3b7ac DC shift time working. Florian Pose <fp@igh-essen.com> parents: 1407 diff changeset	1287	ec_fsm_slave_config_reconfigure(fsm);
8f7bbbd3b7ac DC shift time working. Florian Pose <fp@igh-essen.com> parents: 1407 diff changeset	1288	return;
8f7bbbd3b7ac DC shift time working. Florian Pose <fp@igh-essen.com> parents: 1407 diff changeset	1289	}
8f7bbbd3b7ac DC shift time working. Florian Pose <fp@igh-essen.com> parents: 1407 diff changeset	1290
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1291	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1292	return;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1293
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1294	if (datagram->state != EC_DATAGRAM_RECEIVED) {
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1295	fsm->state = ec_fsm_slave_config_state_error;
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1296	EC_ERR("Failed to receive DC cycle times datagram for slave %u: ",
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1297	slave->ring_position);
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1298	ec_datagram_print_state(datagram);
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1299	return;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1300	}
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1301
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1302	if (datagram->working_counter != 1) {
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1303	slave->error_flag = 1;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1304	fsm->state = ec_fsm_slave_config_state_error;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1305	EC_ERR("Failed to set DC cycle times of slave %u: ",
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1306	slave->ring_position);
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1307	ec_datagram_print_wc_error(datagram);
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1308	return;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1309	}
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1310
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1311	// set DC start time
1436 08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1312	start_time = master->app_time + 100000000ULL; // now + X ns
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1313	// FIXME use slave's local system time here?
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1314
1438 1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1315	if (sync0->cycle_time) {
1436 08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1316	// find correct phase
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1317	if (master->has_start_time) {
1438 1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1318	u64 diff, start;
1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1319	u32 remainder;
1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1320
1436 08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1321	diff = start_time - master->app_start_time;
1438 1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1322	remainder = do_div(diff, sync0->cycle_time);
1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1323
1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1324	start = start_time +
1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1325	sync0->cycle_time - remainder + sync0->shift_time;
1436 08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1326
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1327	if (master->debug_level) {
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1328	EC_DBG("app_start_time=%llu\n", master->app_start_time);
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1329	EC_DBG(" start_time=%llu\n", start_time);
1438 1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1330	EC_DBG(" cycle_time=%u\n", sync0->cycle_time);
1d30b96bb04f Replaced ecrt_slave_config_dc_cycle_times() and ecrt_slave_config_dc_shift_times() by ecrt_slave_config_dc_sync_signals(). Florian Pose <fp@igh-essen.com> parents: 1436 diff changeset	1331	EC_DBG(" shift_time=%u\n", sync0->shift_time);
1436 08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1332	EC_DBG(" remainder=%u\n", remainder);
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1333	EC_DBG(" start=%llu\n", start);
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1334	}
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1335	start_time = start;
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1336	} else {
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1337	EC_WARN("No application time supplied. Cyclic start time will "
1458 bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1338	"not be in phase for slave %u.\n", slave->ring_position);
1436 08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1339	}
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1340	}
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1341
08eaf72409bb Use application start time as a common reference for cyclic generation Florian Pose <fp@igh-essen.com> parents: 1430 diff changeset	1342	if (master->debug_level)
1396 9d04cc08f40f DC sync reference clock to application time. TBC... Florian Pose <fp@igh-essen.com> parents: 1392 diff changeset	1343	EC_DBG("Slave %u: Setting DC cyclic operation start time to %llu.\n",
9d04cc08f40f DC sync reference clock to application time. TBC... Florian Pose <fp@igh-essen.com> parents: 1392 diff changeset	1344	slave->ring_position, start_time);
9d04cc08f40f DC sync reference clock to application time. TBC... Florian Pose <fp@igh-essen.com> parents: 1392 diff changeset	1345
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1346	ec_datagram_fpwr(datagram, slave->station_address, 0x0990, 8);
1396 9d04cc08f40f DC sync reference clock to application time. TBC... Florian Pose <fp@igh-essen.com> parents: 1392 diff changeset	1347	EC_WRITE_U64(datagram->data, start_time);
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1348	fsm->retries = EC_FSM_RETRIES;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1349	fsm->state = ec_fsm_slave_config_state_dc_start;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1350	}
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1351
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1352	/*****************************************************************************/
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1353
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1354	/** Slave configuration state: DC START.
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1355	*/
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1356	void ec_fsm_slave_config_state_dc_start(
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1357	ec_fsm_slave_config_t fsm /< slave state machine /
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1358	)
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1359	{
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1360	ec_datagram_t *datagram = fsm->datagram;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1361	ec_slave_t *slave = fsm->slave;
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1362	ec_slave_config_t *config = slave->config;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1363
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1364	if (!config) { // config removed in the meantime
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1365	ec_fsm_slave_config_reconfigure(fsm);
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1366	return;
e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1367	}
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1368
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1369	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1370	return;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1371
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1372	if (datagram->state != EC_DATAGRAM_RECEIVED) {
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1373	fsm->state = ec_fsm_slave_config_state_error;
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1374	EC_ERR("Failed to receive DC start time datagram for slave %u: ",
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1375	slave->ring_position);
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1376	ec_datagram_print_state(datagram);
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1377	return;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1378	}
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1379
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1380	if (datagram->working_counter != 1) {
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1381	slave->error_flag = 1;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1382	fsm->state = ec_fsm_slave_config_state_error;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1383	EC_ERR("Failed to set DC start time of slave %u: ",
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1384	slave->ring_position);
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1385	ec_datagram_print_wc_error(datagram);
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1386	return;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1387	}
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1388
1458 bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1389	if (slave->master->debug_level)
bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1390	EC_DBG("Slave %u: Setting DC AssignActivate to 0x%04x.\n",
bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1391	slave->ring_position, config->dc_assign_activate);
bba02b6a4492 Debugging output. Florian Pose <fp@igh-essen.com> parents: 1438 diff changeset	1392
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1393	// assign sync unit to EtherCAT or PDI
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1394	ec_datagram_fpwr(datagram, slave->station_address, 0x0980, 2);
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1395	EC_WRITE_U16(datagram->data, config->dc_assign_activate);
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1396	fsm->retries = EC_FSM_RETRIES;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1397	fsm->state = ec_fsm_slave_config_state_dc_assign;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1398	}
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1399
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1400	/*****************************************************************************/
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1401
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1402	/** Slave configuration state: DC ASSIGN.
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1403	*/
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1404	void ec_fsm_slave_config_state_dc_assign(
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1405	ec_fsm_slave_config_t fsm /< slave state machine /
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1406	)
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1407	{
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1408	ec_datagram_t *datagram = fsm->datagram;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1409	ec_slave_t *slave = fsm->slave;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1410
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1411	if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1412	return;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1413
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1414	if (datagram->state != EC_DATAGRAM_RECEIVED) {
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1415	fsm->state = ec_fsm_slave_config_state_error;
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1416	EC_ERR("Failed to receive DC activation datagram for slave %u: ",
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1417	slave->ring_position);
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1520 diff changeset	1418	ec_datagram_print_state(datagram);
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1419	return;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1420	}
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1421
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1422	if (datagram->working_counter != 1) {
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1423	slave->error_flag = 1;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1424	fsm->state = ec_fsm_slave_config_state_error;
1407 e3974f72d31e Improved DC configuration. Florian Pose <fp@igh-essen.com> parents: 1406 diff changeset	1425	EC_ERR("Failed to set DC cyclic operation state of slave %u: ",
1392 8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1426	slave->ring_position);
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1427	ec_datagram_print_wc_error(datagram);
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1428	return;
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1429	}
8fcc1d0987c1 DC cyclic operation and slave configuration. TBC... Florian Pose <fp@igh-essen.com> parents: 1374 diff changeset	1430
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1431	ec_fsm_slave_config_enter_safeop(fsm);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1432	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1433
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1434	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1435
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1436	/** Request SAFEOP state.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1437	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1438	void ec_fsm_slave_config_enter_safeop(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1439	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1440	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1441	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1442	fsm->state = ec_fsm_slave_config_state_safeop;
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1443	ec_fsm_change_start(fsm->fsm_change, fsm->slave, EC_SLAVE_STATE_SAFEOP);
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1444	ec_fsm_change_exec(fsm->fsm_change); // execute immediately
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1445	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1446
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1447	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1448
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1449	/** Slave configuration state: SAFEOP.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1450	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1451	void ec_fsm_slave_config_state_safeop(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1452	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1453	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1454	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1455	ec_master_t *master = fsm->slave->master;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1456	ec_slave_t *slave = fsm->slave;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1457
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1458	if (ec_fsm_change_exec(fsm->fsm_change)) return;
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1459
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1460	if (!ec_fsm_change_success(fsm->fsm_change)) {
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1461	if (!fsm->fsm_change->spontaneous_change)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1462	fsm->slave->error_flag = 1;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1463	fsm->state = ec_fsm_slave_config_state_error;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1464	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1465	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1466
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1467	// slave is now in SAFEOP
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1468
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1469	if (master->debug_level) {
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	1470	EC_DBG("Slave %u is now in SAFEOP.\n", slave->ring_position);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1471	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1472
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1473	if (fsm->slave->current_state == fsm->slave->requested_state) {
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1474	fsm->state = ec_fsm_slave_config_state_end; // successful
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1475	if (master->debug_level) {
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	1476	EC_DBG("Finished configuration of slave %u.\n",
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1477	slave->ring_position);
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1478	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1479	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1480	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1481
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1482	// set state to OP
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1483	fsm->state = ec_fsm_slave_config_state_op;
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1484	ec_fsm_change_start(fsm->fsm_change, slave, EC_SLAVE_STATE_OP);
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1485	ec_fsm_change_exec(fsm->fsm_change); // execute immediately
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1486	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1487
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1488	/*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1489
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1490	/** Slave configuration state: OP
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1491	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1492	void ec_fsm_slave_config_state_op(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1493	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1494	)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1495	{
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1496	ec_master_t *master = fsm->slave->master;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1497	ec_slave_t *slave = fsm->slave;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1498
1174 235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1499	if (ec_fsm_change_exec(fsm->fsm_change)) return;
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1500
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1501	if (!ec_fsm_change_success(fsm->fsm_change)) {
235f34ca50e2 Major Pdo configuration change: Read mapping of unknown Pdos during Florian Pose <fp@igh-essen.com> parents: 1173 diff changeset	1502	if (!fsm->fsm_change->spontaneous_change)
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1503	slave->error_flag = 1;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1504	fsm->state = ec_fsm_slave_config_state_error;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1505	return;
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1506	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1507
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1508	// slave is now in OP
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1509
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1510	if (master->debug_level) {
986 a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	1511	EC_DBG("Slave %u is now in OP.\n", slave->ring_position);
a486591ba86b Replaced misleading %i by %u. Florian Pose <fp@igh-essen.com> parents: 908 diff changeset	1512	EC_DBG("Finished configuration of slave %u.\n", slave->ring_position);
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1513	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1514
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1515	fsm->state = ec_fsm_slave_config_state_end; // successful
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1516	}
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1517
1318 76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1518	/*****************************************************************************/
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1519
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1520	/** Reconfigure the slave starting at INIT.
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1521	*/
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1522	void ec_fsm_slave_config_reconfigure(
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1523	ec_fsm_slave_config_t fsm /< slave state machine /
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1524	)
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1525	{
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1526	if (fsm->slave->master->debug_level) {
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1527	EC_DBG("Slave configuration for slave %u detached during "
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1528	"configuration. Reconfiguring.", fsm->slave->ring_position);
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1529	}
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1530
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1531	ec_fsm_slave_config_enter_init(fsm); // reconfigure
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1532	}
76b4014391bd merge -r1583:1593 branches/stable-1.4: Fixed detaching oops. Florian Pose <fp@igh-essen.com> parents: 1277 diff changeset	1533
830 d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1534	/******************************************************************************
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1535	* Common state functions
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1536	*****************************************************************************/
d83d92e1a919 Separated slave state machines. Florian Pose <fp@igh-essen.com> parents: diff changeset	1537
1064 5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1538	/** State: ERROR.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1539	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1540	void ec_fsm_slave_config_state_error(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1541	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1542	)
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1543	{
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1544	}
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1545
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1546	/*****************************************************************************/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1547
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1548	/** State: END.
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1549	*/
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1550	void ec_fsm_slave_config_state_end(
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1551	ec_fsm_slave_config_t fsm /< slave state machine /
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1552	)
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1553	{
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1554	}
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1555
5f27403587a8 Avoid duplicate reconfiguration. Florian Pose <fp@igh-essen.com> parents: 1055 diff changeset	1556	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Tue, 09 Mar 2010 16:23:30 +0100
changeset 1867	fec951a0a654
parent 1849	0a660edc7180
child 1873	219be3742274
permissions	-rw-r--r--