etherlabmaster: master/fsm_foe.c@fae3a1759126 (annotated)

1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	1	/******************************************************************************
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	3	* $Id$
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	5	* Copyright (C) 2008 Olav Zarges, imc Meßsysteme GmbH
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	6	*
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	7	* This file is part of the IgH EtherCAT Master.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	8	*
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	9	* The IgH EtherCAT Master is free software; you can redistribute it
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	10	* and/or modify it under the terms of the GNU General Public License
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	11	* as published by the Free Software Foundation; either version 2 of the
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	12	* License, or (at your option) any later version.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	13	*
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	14	* The IgH EtherCAT Master is distributed in the hope that it will be
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	15	* useful, but WITHOUT ANY WARRANTY; without even the implied warranty of
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	16	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	17	* GNU General Public License for more details.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	18	*
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	19	* You should have received a copy of the GNU General Public License
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	20	* along with the IgH EtherCAT Master; if not, write to the Free Software
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	21	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	22	*
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	23	* The right to use EtherCAT Technology is granted and comes free of
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	24	* charge under condition of compatibility of product made by
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	25	* Licensee. People intending to distribute/sell products based on the
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	26	* code, have to sign an agreement to guarantee that products using
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	27	* software based on IgH EtherCAT master stay compatible with the actual
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	28	* EtherCAT specification (which are released themselves as an open
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	29	* standard) as the (only) precondition to have the right to use EtherCAT
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	30	* Technology, IP and trade marks.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	31	*
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	32	*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	33
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	34	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	35	\file
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	36	EtherCAT FoE state machines.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	37	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	38
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	39	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	40
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	41	#include "globals.h"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	42	#include "master.h"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	43	#include "mailbox.h"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	44	#include "fsm_foe.h"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	45	#include "foe.h"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	46
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	47	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	48
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	49	/** Maximum time in ms to wait for responses when reading out the dictionary.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	50	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	51	#define EC_FSM_FOE_TIMEOUT 3000
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	52
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	53	#define EC_MBOX_TYPE_FILEACCESS 0x04
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	54
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	55	#define myDEBUG
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	56
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	57	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	58
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	59	int ec_foe_prepare_data_send( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	60	int ec_foe_prepare_wrq_send( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	61	int ec_foe_prepare_rrq_send( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	62	int ec_foe_prepare_send_ack( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	63
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	64	void ec_foe_set_tx_error( ec_fsm_foe_t *, uint32_t );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	65	void ec_foe_set_rx_error( ec_fsm_foe_t *, uint32_t );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	66
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	67	void ec_fsm_foe_write(ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	68	void ec_fsm_foe_read(ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	69	void ec_fsm_foe_end( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	70	void ec_fsm_foe_error( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	71
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	72	void ec_fsm_foe_state_wrq_sent( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	73	void ec_fsm_foe_state_rrq_sent( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	74
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	75	void ec_fsm_foe_state_ack_check( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	76	void ec_fsm_foe_state_ack_read( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	77
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	78	void ec_fsm_foe_state_data_sent( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	79
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	80	void ec_fsm_foe_state_data_check( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	81	void ec_fsm_foe_state_data_read ( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	82	void ec_fsm_foe_state_sent_ack( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	83
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	84	void ec_fsm_foe_write_start( ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	85	void ec_fsm_foe_read_start(ec_fsm_foe_t * );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	86
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	87	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	88
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	89	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	90	Constructor.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	91	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	92
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	93	void ec_fsm_foe_init(ec_fsm_foe_t fsm, /< finite state machine /
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	94	ec_datagram_t datagram /< datagram /
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	95	)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	96	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	97	fsm->state = NULL;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	98	fsm->datagram = datagram;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	99	fsm->rx_errors = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	100	fsm->tx_errors = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	101	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	102
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	103	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	104
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	105	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	106	Destructor.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	107	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	108
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	109	void ec_fsm_foe_clear(ec_fsm_foe_t fsm /< finite state machine /)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	110	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	111	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	112
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	113	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	114
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	115	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	116	Executes the current state of the state machine.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	117	\return false, if state machine has terminated
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	118	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	119
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	120	int ec_fsm_foe_exec(ec_fsm_foe_t fsm /< finite state machine /)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	121	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	122	fsm->state(fsm);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	123
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	124	return fsm->state != ec_fsm_foe_end && fsm->state != ec_fsm_foe_error;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	125	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	126
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	127	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	128
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	129	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	130	Returns, if the state machine terminated with success.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	131	\return non-zero if successful.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	132	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	133
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	134	int ec_fsm_foe_success(ec_fsm_foe_t fsm /< Finite state machine /)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	135	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	136	return fsm->state == ec_fsm_foe_end;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	137	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	138
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	139	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	140
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	141	void ec_fsm_foe_transfer(
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	142	ec_fsm_foe_t fsm, /< State machine. /
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	143	ec_slave_t slave, /< EtherCAT slave. /
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	144	ec_foe_request_t request /< Sdo request. /
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	145	)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	146	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	147	fsm->slave = slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	148	fsm->request = request;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	149	if (request->dir == EC_DIR_OUTPUT) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	150	fsm->state = ec_fsm_foe_write;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	151	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	152	else {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	153	fsm->state = ec_fsm_foe_read;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	154	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	155	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	156
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	157	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	158
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	159	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	160	State: ERROR.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	161	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	162
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	163	void ec_fsm_foe_error(ec_fsm_foe_t fsm /< finite state machine /)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	164	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	165	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	166	printk("ec_fsm_foe_error()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	167	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	168	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	169
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	170	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	171
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	172	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	173	State: END.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	174	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	175
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	176	void ec_fsm_foe_end(ec_fsm_foe_t fsm /< finite state machine /)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	177	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	178	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	179	printk("ec_fsm_foe_end\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	180	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	181	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	182
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	183	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	184
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	185	#define EC_MBOX_HEADER_SIZE 6
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	186	// uint16_t Length
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	187	// uint16_t Address
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	188	// uint8_t reserved
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	189	// uint8_t Type:4
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	190	// uint8_t Counter:4
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	191
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	192	#define EC_FOE_HEADER_SIZE 6
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	193	// uint8_t OpCode
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	194	// uint8_t reserved
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	195	// uint32_t PacketNo, Password, ErrorCode
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	196
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	197	enum {
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	198	EC_FOE_OPCODE_RRQ = 1,
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	199	EC_FOE_OPCODE_WRQ = 2,
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	200	EC_FOE_OPCODE_DATA = 3,
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	201	EC_FOE_OPCODE_ACK = 4,
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	202	EC_FOE_OPCODE_ERR = 5,
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	203	EC_FOE_OPCODE_BUSY = 6
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	204	} ec_foe_opcode_t;
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	205
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	206	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	207	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	208	Sends a file or the next fragment.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	209	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	210
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	211	int ec_foe_prepare_data_send( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	212	size_t remaining_size, current_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	213	uint8_t* data;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	214
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	215	remaining_size = fsm->tx_buffer_size - fsm->tx_buffer_offset;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	216
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	217	if (remaining_size < fsm->slave->sii.tx_mailbox_size - EC_MBOX_HEADER_SIZE - EC_FOE_HEADER_SIZE) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	218	current_size = remaining_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	219	fsm->tx_last_packet = 1;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	220	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	221	else {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	222	current_size = fsm->slave->sii.tx_mailbox_size - EC_MBOX_HEADER_SIZE - EC_FOE_HEADER_SIZE;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	223	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	224
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	225	if (!(data = ec_slave_mbox_prepare_send(fsm->slave, fsm->datagram,
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	226	EC_MBOX_TYPE_FILEACCESS, current_size + EC_FOE_HEADER_SIZE)))
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	227	return -1;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	228
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	229	EC_WRITE_U8 ( data, EC_FOE_OPCODE_DATA ); // OpCode = DataBlock req.
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	230	EC_WRITE_U32( data + 2, fsm->tx_packet_no ); // PacketNo, Password
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	231
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	232	memcpy(data + EC_FOE_HEADER_SIZE, fsm->tx_buffer + fsm->tx_buffer_offset, current_size);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	233
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	234	fsm->tx_current_size = current_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	235
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	236	return 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	237	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	238
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	239	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	240	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	241	Prepare a write request (WRQ) with filename
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	242	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	243
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	244	int ec_foe_prepare_wrq_send( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	245	size_t current_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	246	uint8_t *data;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	247
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	248	fsm->tx_buffer_offset = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	249	fsm->tx_current_size = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	250	fsm->tx_packet_no = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	251	fsm->tx_last_packet = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	252
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	253	current_size = fsm->tx_filename_len;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	254
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	255	if (!(data = ec_slave_mbox_prepare_send(fsm->slave, fsm->datagram,
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	256	EC_MBOX_TYPE_FILEACCESS, current_size + EC_FOE_HEADER_SIZE)))
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	257	return -1;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	258
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	259	EC_WRITE_U16( data, EC_FOE_OPCODE_WRQ); // fsm write request
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	260	EC_WRITE_U32( data + 2, fsm->tx_packet_no );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	261
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	262	memcpy(data + EC_FOE_HEADER_SIZE, fsm->tx_filename, current_size);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	263
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	264	return 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	265	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	266
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	267	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	268
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	269	char tx_buffer[0x1000];
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	270	void ec_fsm_foe_write(ec_fsm_foe_t fsm /< finite state machine /)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	271	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	272	fsm->tx_buffer = fsm->request->buffer;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	273	fsm->tx_buffer_size = fsm->request->data_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	274	fsm->tx_buffer_offset = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	275
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	276	fsm->tx_filename = fsm->request->file_name;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	277	fsm->tx_filename_len = strlen(fsm->tx_filename);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	278
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	279	fsm->state = ec_fsm_foe_write_start;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	280
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	281	#ifdef use_ext_buffer
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	282	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	283	int i;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	284	fsm->tx_data = tx_buffer;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	285	for (i=0 ; i<sizeof(tx_buffer) ; i++) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	286	tx_buffer[i] = (uint8_t)(i);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	287	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	288	fsm->tx_data_len = sizeof(tx_buffer);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	289	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	290	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	291	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	292
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	293	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	294	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	295	Initializes the SII write state machine.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	296	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	297
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	298	void ec_fsm_foe_write_start(ec_fsm_foe_t fsm /< finite state machine /)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	299	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	300	ec_slave_t *slave = fsm->slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	301
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	302	fsm->tx_buffer_offset = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	303	fsm->tx_current_size = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	304	fsm->tx_packet_no = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	305	fsm->tx_last_packet = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	306
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	307	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	308	printk("ec_fsm_foe_write_start()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	309	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	310
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	311	if (!(slave->sii.mailbox_protocols & EC_MBOX_FOE)) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	312	ec_foe_set_tx_error(fsm, FOE_MBOX_PROT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	313	EC_ERR("Slave %u does not support FoE!\n", slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	314	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	315	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	316
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	317	if (ec_foe_prepare_wrq_send(fsm)) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	318	ec_foe_set_tx_error(fsm, FOE_PROT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	319	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	320	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	321
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	322	fsm->state = ec_fsm_foe_state_wrq_sent;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	323	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	324
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	325	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	326
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	327	void ec_fsm_foe_state_ack_check( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	328	ec_datagram_t *datagram = fsm->datagram;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	329	ec_slave_t *slave = fsm->slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	330
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	331	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	332	// printk("ec_fsm_foe_ack_check()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	333	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	334	if (datagram->state != EC_DATAGRAM_RECEIVED) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	335	ec_foe_set_rx_error(fsm, FOE_RECEIVE_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	336	EC_ERR("Failed to receive FoE mailbox check datagram for slave %u"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	337	" (datagram state %u).\n",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	338	slave->ring_position, datagram->state);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	339	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	340	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	341
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	342	if (datagram->working_counter != 1) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	343	// slave hat noch nichts in die Mailbox getan
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	344	ec_foe_set_rx_error(fsm, FOE_WC_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	345	EC_ERR("Reception of FoE mailbox check datagram failed on slave %u: ",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	346	slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	347	ec_datagram_print_wc_error(datagram);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	348	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	349	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	350
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	351	if (!ec_slave_mbox_check(datagram)) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	352	unsigned long diff_ms =
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	353	(datagram->jiffies_received - fsm->jiffies_start) * 1000 / HZ;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	354	if (diff_ms >= EC_FSM_FOE_TIMEOUT) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	355	ec_foe_set_tx_error(fsm, FOE_TIMEOUT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	356	EC_ERR("Timeout while waiting for ack response "
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	357	"on slave %u.\n", slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	358	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	359	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	360	// EC_ERR("WAIT!!!!!!!!!!!!!\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	361	ec_slave_mbox_prepare_check(slave, datagram); // can not fail.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	362	fsm->retries = EC_FSM_RETRIES;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	363	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	364	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	365
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	366	// Fetch response
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	367	ec_slave_mbox_prepare_fetch(slave, datagram); // can not fail.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	368
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	369	fsm->retries = EC_FSM_RETRIES;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	370	fsm->state = ec_fsm_foe_state_ack_read;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	371	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	372
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	373	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	374
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	375	void ec_fsm_foe_state_ack_read( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	376
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	377	ec_datagram_t *datagram = fsm->datagram;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	378	ec_slave_t *slave = fsm->slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	379	uint8_t *data, mbox_prot;
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	380	uint8_t opCode;
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	381	size_t rec_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	382
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	383	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	384	printk("ec_fsm_foe_ack_read()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	385	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	386	if (datagram->state != EC_DATAGRAM_RECEIVED) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	387	ec_foe_set_rx_error(fsm, FOE_RECEIVE_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	388	EC_ERR("Failed to receive FoE ack response datagram for"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	389	" slave %u (datagram state %u).\n",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	390	slave->ring_position, datagram->state);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	391	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	392	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	393
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	394	if (datagram->working_counter != 1) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	395	ec_foe_set_rx_error(fsm, FOE_WC_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	396	EC_ERR("Reception of FoE ack response failed on slave %u: ",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	397	slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	398	ec_datagram_print_wc_error(datagram);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	399	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	400	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	401
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	402	if (!(data = ec_slave_mbox_fetch(fsm->slave, datagram, &mbox_prot, &rec_size))) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	403	ec_foe_set_tx_error(fsm, FOE_PROT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	404	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	405	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	406
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	407	if (mbox_prot != EC_MBOX_TYPE_FILEACCESS) { // FoE
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	408	ec_foe_set_tx_error(fsm, FOE_MBOX_PROT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	409	EC_ERR("Received mailbox protocol 0x%02X as response.\n", mbox_prot);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	410	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	411	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	412
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	413	opCode = EC_READ_U8(data);
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	414
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	415	if (opCode == EC_FOE_OPCODE_BUSY) {
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	416	// slave ist noch nicht bereit
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	417	if (ec_foe_prepare_data_send(fsm)) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	418	ec_foe_set_tx_error(fsm, FOE_PROT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	419	EC_ERR("Slave is busy.\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	420	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	421	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	422	fsm->state = ec_fsm_foe_state_data_sent;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	423	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	424	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	425
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	426	if (opCode == EC_FOE_OPCODE_ACK) {
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	427	fsm->tx_packet_no++;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	428	fsm->tx_buffer_offset += fsm->tx_current_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	429
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	430	if (fsm->tx_last_packet) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	431	fsm->state = ec_fsm_foe_end;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	432	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	433	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	434
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	435	if (ec_foe_prepare_data_send(fsm)) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	436	ec_foe_set_tx_error(fsm, FOE_PROT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	437	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	438	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	439	fsm->state = ec_fsm_foe_state_data_sent;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	440	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	441	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	442	ec_foe_set_tx_error(fsm, FOE_ACK_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	443	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	444
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	445	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	446	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	447	State: WRQ SENT.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	448	Checks is the previous transmit datagram succeded and sends the next
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	449	fragment, if necessary.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	450	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	451
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	452	void ec_fsm_foe_state_wrq_sent( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	453	ec_datagram_t *datagram = fsm->datagram;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	454	ec_slave_t *slave = fsm->slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	455
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	456	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	457	printk("ec_foe_state_sent_wrq()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	458	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	459	if (datagram->state != EC_DATAGRAM_RECEIVED) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	460	ec_foe_set_rx_error(fsm, FOE_RECEIVE_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	461	EC_ERR("Failed to send FoE WRQ for slave %u"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	462	" (datagram state %u).\n",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	463	slave->ring_position, datagram->state);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	464	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	465	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	466
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	467	if (datagram->working_counter != 1) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	468	// slave hat noch nichts in die Mailbox getan
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	469	ec_foe_set_rx_error(fsm, FOE_WC_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	470	EC_ERR("Reception of FoE WRQ failed on slave %u: ",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	471	slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	472	ec_datagram_print_wc_error(datagram);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	473	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	474	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	475
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	476	fsm->jiffies_start = datagram->jiffies_sent;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	477
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	478	ec_slave_mbox_prepare_check(fsm->slave, datagram); // can not fail.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	479
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	480	fsm->retries = EC_FSM_RETRIES;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	481	fsm->state = ec_fsm_foe_state_ack_check;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	482	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	483
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	484	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	485	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	486	State: WRQ SENT.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	487	Checks is the previous transmit datagram succeded and sends the next
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	488	fragment, if necessary.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	489	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	490
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	491	void ec_fsm_foe_state_data_sent( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	492	ec_datagram_t *datagram = fsm->datagram;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	493	ec_slave_t *slave = fsm->slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	494
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	495	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	496	printk("ec_fsm_foe_state_data_sent()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	497	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	498	if (fsm->datagram->state != EC_DATAGRAM_RECEIVED) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	499	ec_foe_set_tx_error(fsm, FOE_RECEIVE_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	500	EC_ERR("Failed to receive FoE ack response datagram for"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	501	" slave %u (datagram state %u).\n",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	502	slave->ring_position, datagram->state);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	503	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	504	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	505
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	506	if (fsm->datagram->working_counter != 1) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	507	ec_foe_set_tx_error(fsm, FOE_WC_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	508	EC_ERR("Reception of FoE data send failed on slave %u: ",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	509	slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	510	ec_datagram_print_wc_error(datagram);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	511	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	512	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	513
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	514	ec_slave_mbox_prepare_check(fsm->slave, fsm->datagram);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	515	fsm->jiffies_start = jiffies;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	516	fsm->retries = EC_FSM_RETRIES;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	517	fsm->state = ec_fsm_foe_state_ack_check;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	518	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	519
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	520	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	521	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	522	Prepare a read request (RRQ) with filename
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	523	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	524
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	525	int ec_foe_prepare_rrq_send( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	526	size_t current_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	527	uint8_t *data;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	528
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	529	current_size = fsm->rx_filename_len;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	530
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	531	if (!(data = ec_slave_mbox_prepare_send(fsm->slave, fsm->datagram,
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	532	EC_MBOX_TYPE_FILEACCESS, current_size + EC_FOE_HEADER_SIZE)))
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	533	return -1;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	534
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	535	EC_WRITE_U16(data, EC_FOE_OPCODE_RRQ); // fsm read request
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	536	EC_WRITE_U32(data + 2, 0x00000000); // no passwd
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	537	memcpy(data + EC_FOE_HEADER_SIZE, fsm->rx_filename, current_size);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	538
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	539	if (fsm->slave->master->debug_level) {
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	540	EC_DBG("FoE Read Request:\n");
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	541	ec_print_data(data, current_size + EC_FOE_HEADER_SIZE);
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	542	}
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	543
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	544	return 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	545	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	546
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	547
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	548	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	549
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	550	int ec_foe_prepare_send_ack( ec_fsm_foe_t *foe ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	551	uint8_t *data;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	552
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	553	if (!(data = ec_slave_mbox_prepare_send(foe->slave, foe->datagram,
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	554	EC_MBOX_TYPE_FILEACCESS, EC_FOE_HEADER_SIZE)))
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	555	return -1;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	556
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	557	EC_WRITE_U16( data, EC_FOE_OPCODE_ACK);
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	558	EC_WRITE_U32( data + 2, foe->rx_expected_packet_no );
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	559
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	560	return 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	561	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	562
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	563	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	564	/**
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	565	State: RRQ SENT.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	566	Checks is the previous transmit datagram succeded and sends the next
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	567	fragment, if necessary.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	568	*/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	569
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	570	void ec_fsm_foe_state_rrq_sent( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	571	ec_datagram_t *datagram = fsm->datagram;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	572	ec_slave_t *slave = fsm->slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	573
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	574	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	575	printk("ec_foe_state_rrq_sent()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	576	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	577	if (datagram->state != EC_DATAGRAM_RECEIVED) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	578	ec_foe_set_rx_error(fsm, FOE_RECEIVE_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	579	EC_ERR("Failed to send FoE RRQ for slave %u"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	580	" (datagram state %u).\n",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	581	slave->ring_position, datagram->state);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	582	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	583	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	584
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	585	if (datagram->working_counter != 1) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	586	// slave hat noch nichts in die Mailbox getan
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	587	ec_foe_set_rx_error(fsm, FOE_WC_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	588	EC_ERR("Reception of FoE RRQ failed on slave %u: ",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	589	slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	590	ec_datagram_print_wc_error(datagram);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	591	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	592	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	593
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	594	fsm->jiffies_start = datagram->jiffies_sent;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	595
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	596	ec_slave_mbox_prepare_check(fsm->slave, datagram); // can not fail.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	597
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	598	fsm->retries = EC_FSM_RETRIES;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	599	fsm->state = ec_fsm_foe_state_data_check;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	600	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	601
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	602	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	603
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	604	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	605	char rx_buffer[0x8000];
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	606	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	607
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	608	void ec_fsm_foe_read(ec_fsm_foe_t fsm /< finite state machine /)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	609	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	610	fsm->state = ec_fsm_foe_read_start;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	611	fsm->rx_filename = fsm->request->file_name;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	612	fsm->rx_filename_len = strlen(fsm->rx_filename);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	613
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	614	fsm->rx_buffer = fsm->request->buffer;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	615	fsm->rx_buffer_size = fsm->request->buffer_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	616
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	617	#ifdef use_ext_buffer
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	618	fsm->rx_buffer = rx_buffer;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	619	fsm->rx_buffer_size = sizeof(rx_buffer);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	620	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	621	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	622
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	623	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	624
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	625	void ec_fsm_foe_read_start(ec_fsm_foe_t fsm /< finite state machine /)
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	626	{
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	627	size_t current_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	628	ec_slave_t *slave = fsm->slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	629
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	630	fsm->rx_buffer_offset = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	631	fsm->rx_current_size = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	632	fsm->rx_packet_no = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	633	fsm->rx_expected_packet_no = 1;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	634	fsm->rx_last_packet = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	635
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	636	current_size = fsm->rx_filename_len;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	637
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	638	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	639	printk("ec_fsm_foe_read_start()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	640	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	641	if (!(slave->sii.mailbox_protocols & EC_MBOX_FOE)) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	642	ec_foe_set_tx_error(fsm, FOE_MBOX_PROT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	643	EC_ERR("Slave %u does not support FoE!\n", slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	644	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	645	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	646
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	647	if (ec_foe_prepare_rrq_send(fsm)) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	648	ec_foe_set_rx_error(fsm, FOE_PROT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	649	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	650	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	651
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	652	fsm->state = ec_fsm_foe_state_rrq_sent;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	653	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	654
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	655	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	656
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	657	void ec_fsm_foe_state_data_check ( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	658	ec_datagram_t *datagram = fsm->datagram;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	659	ec_slave_t *slave = fsm->slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	660
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	661	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	662	printk("ec_fsm_foe_state_data_check()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	663	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	664	if (datagram->state != EC_DATAGRAM_RECEIVED) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	665	ec_foe_set_rx_error(fsm, FOE_RECEIVE_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	666	EC_ERR("Failed to send FoE DATA READ for slave %u"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	667	" (datagram state %u).\n",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	668	slave->ring_position, datagram->state);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	669	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	670	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	671
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	672	if (datagram->working_counter != 1) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	673	ec_foe_set_rx_error(fsm, FOE_WC_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	674	EC_ERR("Reception of FoE DATA READ on slave %u: ",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	675	slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	676	ec_datagram_print_wc_error(datagram);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	677	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	678	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	679
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	680	if (!ec_slave_mbox_check(datagram)) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	681	unsigned long diff_ms =
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	682	(datagram->jiffies_received - fsm->jiffies_start) * 1000 / HZ;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	683	if (diff_ms >= EC_FSM_FOE_TIMEOUT) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	684	ec_foe_set_tx_error(fsm, FOE_TIMEOUT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	685	EC_ERR("Timeout while waiting for ack response "
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	686	"on slave %u.\n", slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	687	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	688	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	689
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	690	ec_slave_mbox_prepare_check(slave, datagram); // can not fail.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	691	fsm->retries = EC_FSM_RETRIES;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	692	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	693	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	694
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	695	// Fetch response
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	696	ec_slave_mbox_prepare_fetch(slave, datagram); // can not fail.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	697
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	698	fsm->retries = EC_FSM_RETRIES;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	699	fsm->state = ec_fsm_foe_state_data_read;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	700
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	701	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	702
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	703	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	704
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	705	void ec_fsm_foe_state_data_read ( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	706	size_t rec_size;
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	707	uint8_t *data, opCode, packet_no, mbox_prot;
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	708
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	709	ec_datagram_t *datagram = fsm->datagram;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	710	ec_slave_t *slave = fsm->slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	711
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	712	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	713	printk("ec_fsm_foe_state_data_read()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	714	#endif
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	715
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	716	if (datagram->state != EC_DATAGRAM_RECEIVED) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	717	ec_foe_set_rx_error(fsm, FOE_RECEIVE_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	718	EC_ERR("Failed to receive FoE DATA READ datagram for"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	719	" slave %u (datagram state %u).\n",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	720	slave->ring_position, datagram->state);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	721	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	722	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	723
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	724	if (datagram->working_counter != 1) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	725	ec_foe_set_rx_error(fsm, FOE_WC_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	726	EC_ERR("Reception of FoE DATA READ failed on slave %u: ",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	727	slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	728	ec_datagram_print_wc_error(datagram);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	729	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	730	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	731
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	732	if (!(data = ec_slave_mbox_fetch(slave, datagram, &mbox_prot, &rec_size))) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	733	ec_foe_set_rx_error(fsm, FOE_MBOX_FETCH_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	734	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	735	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	736
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	737	if (mbox_prot != EC_MBOX_TYPE_FILEACCESS) { // FoE
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	738	EC_ERR("Received mailbox protocol 0x%02X as response.\n", mbox_prot);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	739	ec_foe_set_rx_error(fsm, FOE_PROT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	740	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	741	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	742
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	743	opCode = EC_READ_U8(data);
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	744
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	745	if (opCode == EC_FOE_OPCODE_BUSY) {
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	746	if (ec_foe_prepare_send_ack(fsm)) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	747	ec_foe_set_rx_error(fsm, FOE_PROT_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	748	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	749	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	750	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	751
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	752	if (opCode == EC_FOE_OPCODE_ERR) {
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	753	fsm->request->error_code = EC_READ_U32(data + 2);
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	754	EC_ERR("Received FoE Error Request (code %08x) on slave %u.\n",
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	755	fsm->request->error_code, slave->ring_position);
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	756	if (rec_size > 6) {
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	757	uint8_t text[1024];
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	758	strncpy(text, data + 6, min(rec_size - 6, sizeof(text)));
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	759	EC_ERR("FoE Error Text: %s\n", text);
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	760	}
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	761	ec_foe_set_rx_error(fsm, FOE_OPCODE_ERROR);
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	762	return;
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	763	}
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	764
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	765	if (opCode != EC_FOE_OPCODE_DATA) {
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	766	EC_ERR("Received OPCODE %x, expected %x on slave %u.\n",
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	767	opCode, EC_FOE_OPCODE_DATA, slave->ring_position);
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	768	fsm->request->error_code = 0x00000000;
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	769	ec_foe_set_rx_error(fsm, FOE_OPCODE_ERROR);
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	770	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	771	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	772
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	773	packet_no = EC_READ_U16(data + 2);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	774	if (packet_no != fsm->rx_expected_packet_no) {
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	775	EC_ERR("Received unexpected packet number on slave %u.\n",
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	776	slave->ring_position);
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	777	ec_foe_set_rx_error(fsm, FOE_PACKETNO_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	778	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	779	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	780
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	781	rec_size -= EC_FOE_HEADER_SIZE;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	782
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	783	if (fsm->rx_buffer_size >= fsm->rx_buffer_offset + rec_size) {
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	784	memcpy(fsm->rx_buffer + fsm->rx_buffer_offset,
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	785	data + EC_FOE_HEADER_SIZE, rec_size);
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	786	fsm->rx_buffer_offset += rec_size;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	787	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	788
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	789	fsm->rx_last_packet =
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	790	(rec_size + EC_MBOX_HEADER_SIZE + EC_FOE_HEADER_SIZE
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	791	!= fsm->slave->sii.rx_mailbox_size);
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	792
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	793	if (fsm->rx_last_packet \|\|
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	794	(slave->sii.rx_mailbox_size - EC_MBOX_HEADER_SIZE
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	795	- EC_FOE_HEADER_SIZE + fsm->rx_buffer_offset) <= fsm->rx_buffer_size) {
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	796	// either it was the last packet or a new packet will fit into the delivered buffer
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	797	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	798	printk ("last_packet=true\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	799	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	800	if (ec_foe_prepare_send_ack(fsm)) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	801	ec_foe_set_rx_error(fsm, FOE_RX_DATA_ACK_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	802	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	803	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	804
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	805	fsm->state = ec_fsm_foe_state_sent_ack;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	806	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	807	else {
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	808	// no more data fits into the delivered buffer
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	809	// ... wait for new read request
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	810	printk ("ERROR: data doesn't fit in receive buffer\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	811	printk (" rx_buffer_size = %d\n", fsm->rx_buffer_size);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	812	printk (" rx_buffer_offset= %d\n", fsm->rx_buffer_offset);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	813	printk (" rec_size = %d\n", rec_size);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	814	printk (" rx_mailbox_size = %d\n", slave->sii.rx_mailbox_size);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	815	printk (" rx_last_packet = %d\n", fsm->rx_last_packet);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	816	// fsm->state = ec_fsm_state_wait_next_read;
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	817	fsm->request->result = FOE_READY;
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	818	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	819	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	820
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	821	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	822
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	823	void ec_fsm_foe_state_sent_ack( ec_fsm_foe_t *fsm ) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	824
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	825	ec_datagram_t *datagram = fsm->datagram;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	826	ec_slave_t *slave = fsm->slave;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	827
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	828	#ifdef myDEBUG
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	829	printk("ec_foe_state_sent_ack()\n");
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	830	#endif
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	831	if (datagram->state != EC_DATAGRAM_RECEIVED) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	832	ec_foe_set_rx_error(fsm, FOE_RECEIVE_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	833	EC_ERR("Failed to send FoE ACK for slave %u"
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	834	" (datagram state %u).\n",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	835	slave->ring_position, datagram->state);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	836	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	837	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	838
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	839	if (datagram->working_counter != 1) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	840	// slave hat noch nichts in die Mailbox getan
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	841	ec_foe_set_rx_error(fsm, FOE_WC_ERROR);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	842	EC_ERR("Reception of FoE ACK failed on slave %u: ",
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	843	slave->ring_position);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	844	ec_datagram_print_wc_error(datagram);
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	845	return;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	846	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	847
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	848	fsm->jiffies_start = datagram->jiffies_sent;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	849
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	850	ec_slave_mbox_prepare_check(fsm->slave, datagram); // can not fail.
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	851
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	852	if (fsm->rx_last_packet) {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	853	fsm->rx_expected_packet_no = 0;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	854	fsm->request->data_size = fsm->rx_buffer_offset;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	855	fsm->state = ec_fsm_foe_end;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	856	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	857	else {
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	858	fsm->rx_expected_packet_no++;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	859	fsm->retries = EC_FSM_RETRIES;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	860	fsm->state = ec_fsm_foe_state_data_check;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	861	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	862	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	863
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	864	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	865
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	866	void ec_foe_set_tx_error(ec_fsm_foe_t *fsm, uint32_t errorcode)
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	867	{
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	868	fsm->tx_errors++;
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	869	fsm->request->result = errorcode;
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	870	fsm->state = ec_fsm_foe_error;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	871	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	872
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	873	/*****************************************************************************/
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	874
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	875	void ec_foe_set_rx_error(ec_fsm_foe_t *fsm, uint32_t errorcode)
fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	876	{
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	877	fsm->rx_errors++;
1708 fae3a1759126 Improved FoE. Florian Pose <fp@igh-essen.com> parents: 1707 diff changeset	878	fsm->request->result = errorcode;
1707 11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	879	fsm->state = ec_fsm_foe_error;
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	880	}
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	881
11ec009e145d Included FoE patch from Olav Zarges. Florian Pose <fp@igh-essen.com> parents: diff changeset	882	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Mon, 19 Jan 2009 12:36:18 +0000
branch	1.4-foe
changeset 1708	fae3a1759126
parent 1707	11ec009e145d
child 1337	0253c74d0940
permissions	-rw-r--r--