etherlabmaster: master/datagram.c@775d1a02f204 (annotated)

98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	1	/******************************************************************************
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
2081 9c3fd68997d4 Fixed datagram statistics output (skipped datagrams). Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	3	* $Id: datagram.c,v 74e6ac2369f4 2010/02/23 14:13:56 fp $
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
1326 ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	5	* Copyright (C) 2006-2008 Florian Pose, Ingenieurgemeinschaft IgH
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	6	*
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	7	* This file is part of the IgH EtherCAT Master.
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	8	*
1326 ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	9	* The IgH EtherCAT Master is free software; you can redistribute it and/or
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	10	* modify it under the terms of the GNU General Public License version 2, as
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	11	* published by the Free Software Foundation.
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	12	*
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	13	* The IgH EtherCAT Master is distributed in the hope that it will be useful,
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	16	* Public License for more details.
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	17	*
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	18	* You should have received a copy of the GNU General Public License along
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only. Florian Pose <fp@igh-essen.com> parents: 1313 diff changeset	19	* with the IgH EtherCAT Master; if not, write to the Free Software
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	20	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	21	*
1363 11c0b2caa253 Improved and added license headers. Florian Pose <fp@igh-essen.com> parents: 1333 diff changeset	22	* ---
11c0b2caa253 Improved and added license headers. Florian Pose <fp@igh-essen.com> parents: 1333 diff changeset	23	*
11c0b2caa253 Improved and added license headers. Florian Pose <fp@igh-essen.com> parents: 1333 diff changeset	24	* The license mentioned above concerns the source code only. Using the
11c0b2caa253 Improved and added license headers. Florian Pose <fp@igh-essen.com> parents: 1333 diff changeset	25	* EtherCAT technology and brand is only permitted in compliance with the
11c0b2caa253 Improved and added license headers. Florian Pose <fp@igh-essen.com> parents: 1333 diff changeset	26	* industrial property and similar rights of Beckhoff Automation GmbH.
246 0bf7c769de06 Changed license headers and added EtherCAT license notice. Florian Pose <fp@igh-essen.com> parents: 237 diff changeset	27	*
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	28	*****************************************************************************/
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	29
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	30	/**
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	31	\file
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	32	Methods of an EtherCAT datagram.
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	33	*/
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	34
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	35	/*****************************************************************************/
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	36
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	37	#include <linux/slab.h>
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	38
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	39	#include "datagram.h"
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	40	#include "master.h"
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	41
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	42	/*****************************************************************************/
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	43
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	44	/** \cond */
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	45
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	46	#define EC_FUNC_HEADER \
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	47	ret = ec_datagram_prealloc(datagram, data_size); \
ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	48	if (unlikely(ret)) \
ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	49	return ret; \
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	50	datagram->index = 0; \
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	51	datagram->working_counter = 0; \
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 293 diff changeset	52	datagram->state = EC_DATAGRAM_INIT;
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	53
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	54	#define EC_FUNC_FOOTER \
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	55	datagram->data_size = data_size; \
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	56	return 0;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	57
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	58	/** \endcond */
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	59
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	60	/*****************************************************************************/
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	61
816 d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	62	/** Array of datagram type strings used in ec_datagram_type_string().
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	63	*
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	64	* \attention This is indexed by ec_datagram_type_t.
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	65	*/
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	66	static const char *type_strings[] = {
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	67	"?",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	68	"APRD",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	69	"APWR",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	70	"APRW",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	71	"FPRD",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	72	"FPWR",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	73	"FPRW",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	74	"BRD",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	75	"BWR",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	76	"BRW",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	77	"LRD",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	78	"LWR",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	79	"LRW",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	80	"ARMW",
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	81	"FRMW"
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	82	};
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	83
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	84	/*****************************************************************************/
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	85
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	86	/** Constructor.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	87	*/
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	88	void ec_datagram_init(ec_datagram_t datagram /< EtherCAT datagram. /)
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	89	{
446 8fede404c01f Persistent slave lists. Florian Pose <fp@igh-essen.com> parents: 398 diff changeset	90	INIT_LIST_HEAD(&datagram->queue); // mark as unqueued
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 293 diff changeset	91	datagram->type = EC_DATAGRAM_NONE;
708 90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 514 diff changeset	92	memset(datagram->address, 0x00, EC_ADDR_LEN);
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	93	datagram->data = NULL;
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	94	datagram->data_origin = EC_ORIG_INTERNAL;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	95	datagram->mem_size = 0;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	96	datagram->data_size = 0;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	97	datagram->index = 0x00;
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	98	datagram->working_counter = 0x0000;
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 293 diff changeset	99	datagram->state = EC_DATAGRAM_INIT;
1040 d2527675cdd5 Disable use of CPU timestamp counter by default. Florian Pose <fp@igh-essen.com> parents: 998 diff changeset	100	#ifdef EC_HAVE_CYCLES
344 5d8281f1aa2a Replaced longer cycle timestamps with jiffies. Florian Pose <fp@igh-essen.com> parents: 325 diff changeset	101	datagram->cycles_sent = 0;
1040 d2527675cdd5 Disable use of CPU timestamp counter by default. Florian Pose <fp@igh-essen.com> parents: 998 diff changeset	102	#endif
398 ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	103	datagram->jiffies_sent = 0;
1040 d2527675cdd5 Disable use of CPU timestamp counter by default. Florian Pose <fp@igh-essen.com> parents: 998 diff changeset	104	#ifdef EC_HAVE_CYCLES
398 ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	105	datagram->cycles_received = 0;
1040 d2527675cdd5 Disable use of CPU timestamp counter by default. Florian Pose <fp@igh-essen.com> parents: 998 diff changeset	106	#endif
398 ff37601361a8 Fixed serveral races while starting up under high CPU load. Florian Pose <fp@igh-essen.com> parents: 397 diff changeset	107	datagram->jiffies_received = 0;
719 03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	108	datagram->skip_count = 0;
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	109	datagram->stats_output_jiffies = 0;
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	110	memset(datagram->name, 0x00, EC_DATAGRAM_NAME_SIZE);
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	111	}
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	112
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	113	/*****************************************************************************/
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	114
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	115	/** Destructor.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	116	*/
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	117	void ec_datagram_clear(ec_datagram_t datagram /< EtherCAT datagram. /)
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	118	{
1553 4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	119	ec_datagram_unqueue(datagram);
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	120
1333 7b9898062c8f merge -c1614 branches/stable-1.4: Fixed datagram cleaning. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	121	if (datagram->data_origin == EC_ORIG_INTERNAL && datagram->data) {
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	122	kfree(datagram->data);
1507 68e89abadd19 Removed unwanted tabulators. Florian Pose <fp@igh-essen.com> parents: 1363 diff changeset	123	datagram->data = NULL;
1333 7b9898062c8f merge -c1614 branches/stable-1.4: Fixed datagram cleaning. Florian Pose <fp@igh-essen.com> parents: 1326 diff changeset	124	}
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	125	}
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	126
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	127	/*****************************************************************************/
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	128
1553 4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	129	/** Unqueue datagram.
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	130	*/
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	131	void ec_datagram_unqueue(ec_datagram_t datagram /< EtherCAT datagram. /)
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	132	{
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	133	if (!list_empty(&datagram->queue)) {
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	134	list_del_init(&datagram->queue);
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	135	}
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	136	}
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	137
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	138	/*****************************************************************************/
4e8d56d6f12a Bugfix: Unqueue datagram before destroying. Florian Pose <fp@igh-essen.com> parents: 1543 diff changeset	139
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	140	/** Allocates internal payload memory.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	141	*
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	142	* If the allocated memory is already larger than requested, nothing ist done.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	143	*
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	144	* \attention If external payload memory has been provided, no range checking
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	145	* is done!
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	146	*
1312 74853e018898 Created backend versions of all API functions returing a pointer; using Florian Pose <fp@igh-essen.com> parents: 1225 diff changeset	147	* \return 0 in case of success, otherwise \a -ENOMEM.
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	148	*/
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	149	int ec_datagram_prealloc(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	150	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	151	size_t size /*< New payload size in bytes. /
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	152	)
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	153	{
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	154	if (datagram->data_origin == EC_ORIG_EXTERNAL
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	155	\|\| size <= datagram->mem_size)
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	156	return 0;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	157
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	158	if (datagram->data) {
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	159	kfree(datagram->data);
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	160	datagram->data = NULL;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	161	datagram->mem_size = 0;
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	162	}
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	163
998 05a24788f3b2 Replaced a few GFP_ATOMIC allocations with GFP_KERNEL ones. Florian Pose <fp@igh-essen.com> parents: 986 diff changeset	164	if (!(datagram->data = kmalloc(size, GFP_KERNEL))) {
1543 373cd456dc26 Avoid warnings on x86_64 platform. Thanks to Thomas Elste. Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	165	EC_ERR("Failed to allocate %zu bytes of datagram memory!\n", size);
1312 74853e018898 Created backend versions of all API functions returing a pointer; using Florian Pose <fp@igh-essen.com> parents: 1225 diff changeset	166	return -ENOMEM;
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	167	}
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	168
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	169	datagram->mem_size = size;
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	170	return 0;
fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	171	}
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	172
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	173	/*****************************************************************************/
f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	174
1225 4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1040 diff changeset	175	/** Fills the datagram payload memory with zeros.
4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1040 diff changeset	176	*/
4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1040 diff changeset	177	void ec_datagram_zero(ec_datagram_t datagram /< EtherCAT datagram. /)
4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1040 diff changeset	178	{
4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1040 diff changeset	179	memset(datagram->data, 0x00, datagram->data_size);
4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1040 diff changeset	180	}
4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1040 diff changeset	181
4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1040 diff changeset	182	/*****************************************************************************/
4d5b739edcb5 Introduced ec_datagram_zero(). Florian Pose <fp@igh-essen.com> parents: 1040 diff changeset	183
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	184	/** Initializes an EtherCAT APRD datagram.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	185	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	186	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	187	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	188	int ec_datagram_aprd(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	189	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	190	uint16_t ring_position, /*< Auto-increment address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	191	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	192	size_t data_size /*< Number of bytes to read. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	193	)
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	194	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	195	int ret;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	196	EC_FUNC_HEADER;
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 293 diff changeset	197	datagram->type = EC_DATAGRAM_APRD;
708 90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 514 diff changeset	198	EC_WRITE_S16(datagram->address, (int16_t) ring_position * (-1));
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	199	EC_WRITE_U16(datagram->address + 2, mem_address);
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	200	EC_FUNC_FOOTER;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	201	}
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	202
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	203	/*****************************************************************************/
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	204
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	205	/** Initializes an EtherCAT APWR datagram.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	206	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	207	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	208	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	209	int ec_datagram_apwr(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	210	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	211	uint16_t ring_position, /*< Auto-increment address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	212	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	213	size_t data_size /*< Number of bytes to write. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	214	)
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	215	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	216	int ret;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	217	EC_FUNC_HEADER;
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 293 diff changeset	218	datagram->type = EC_DATAGRAM_APWR;
708 90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 514 diff changeset	219	EC_WRITE_S16(datagram->address, (int16_t) ring_position * (-1));
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	220	EC_WRITE_U16(datagram->address + 2, mem_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	221	EC_FUNC_FOOTER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	222	}
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	223
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	224	/*****************************************************************************/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	225
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	226	/** Initializes an EtherCAT APRW datagram.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	227	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	228	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	229	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	230	int ec_datagram_aprw(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	231	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	232	uint16_t ring_position, /*< Auto-increment address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	233	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	234	size_t data_size /*< Number of bytes to write. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	235	)
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	236	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	237	int ret;
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	238	EC_FUNC_HEADER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	239	datagram->type = EC_DATAGRAM_APRW;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	240	EC_WRITE_S16(datagram->address, (int16_t) ring_position * (-1));
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	241	EC_WRITE_U16(datagram->address + 2, mem_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	242	EC_FUNC_FOOTER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	243	}
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	244
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	245	/*****************************************************************************/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	246
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	247	/** Initializes an EtherCAT ARMW datagram.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	248	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	249	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	250	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	251	int ec_datagram_armw(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	252	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	253	uint16_t ring_position, /*< Auto-increment address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	254	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	255	size_t data_size /*< Number of bytes to read. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	256	)
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	257	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	258	int ret;
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	259	EC_FUNC_HEADER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	260	datagram->type = EC_DATAGRAM_ARMW;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	261	EC_WRITE_S16(datagram->address, (int16_t) ring_position * (-1));
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	262	EC_WRITE_U16(datagram->address + 2, mem_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	263	EC_FUNC_FOOTER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	264	}
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	265
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	266	/*****************************************************************************/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	267
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	268	/** Initializes an EtherCAT FPRD datagram.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	269	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	270	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	271	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	272	int ec_datagram_fprd(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	273	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	274	uint16_t configured_address, /*< Configured station address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	275	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	276	size_t data_size /*< Number of bytes to read. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	277	)
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	278	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	279	int ret;
ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	280
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	281	if (unlikely(configured_address == 0x0000))
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	282	EC_WARN("Using configured station address 0x0000!\n");
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	283
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	284	EC_FUNC_HEADER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	285	datagram->type = EC_DATAGRAM_FPRD;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	286	EC_WRITE_U16(datagram->address, configured_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	287	EC_WRITE_U16(datagram->address + 2, mem_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	288	EC_FUNC_FOOTER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	289	}
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	290
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	291	/*****************************************************************************/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	292
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	293	/** Initializes an EtherCAT FPWR datagram.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	294	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	295	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	296	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	297	int ec_datagram_fpwr(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	298	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	299	uint16_t configured_address, /*< Configured station address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	300	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	301	size_t data_size /*< Number of bytes to write. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	302	)
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	303	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	304	int ret;
ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	305
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	306	if (unlikely(configured_address == 0x0000))
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	307	EC_WARN("Using configured station address 0x0000!\n");
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	308
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	309	EC_FUNC_HEADER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	310	datagram->type = EC_DATAGRAM_FPWR;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	311	EC_WRITE_U16(datagram->address, configured_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	312	EC_WRITE_U16(datagram->address + 2, mem_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	313	EC_FUNC_FOOTER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	314	}
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	315
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	316	/*****************************************************************************/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	317
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	318	/** Initializes an EtherCAT FPRW datagram.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	319	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	320	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	321	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	322	int ec_datagram_fprw(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	323	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	324	uint16_t configured_address, /*< Configured station address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	325	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	326	size_t data_size /*< Number of bytes to write. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	327	)
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	328	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	329	int ret;
ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	330
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	331	if (unlikely(configured_address == 0x0000))
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	332	EC_WARN("Using configured station address 0x0000!\n");
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	333
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	334	EC_FUNC_HEADER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	335	datagram->type = EC_DATAGRAM_FPRW;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	336	EC_WRITE_U16(datagram->address, configured_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	337	EC_WRITE_U16(datagram->address + 2, mem_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	338	EC_FUNC_FOOTER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	339	}
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	340
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	341	/*****************************************************************************/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	342
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	343	/** Initializes an EtherCAT FRMW datagram.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	344	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	345	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	346	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	347	int ec_datagram_frmw(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	348	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	349	uint16_t configured_address, /*< Configured station address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	350	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	351	size_t data_size /*< Number of bytes to write. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	352	)
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	353	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	354	int ret;
ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	355
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	356	if (unlikely(configured_address == 0x0000))
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	357	EC_WARN("Using configured station address 0x0000!\n");
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	358
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	359	EC_FUNC_HEADER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	360	datagram->type = EC_DATAGRAM_FRMW;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	361	EC_WRITE_U16(datagram->address, configured_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	362	EC_WRITE_U16(datagram->address + 2, mem_address);
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	363	EC_FUNC_FOOTER;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	364	}
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	365
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	366	/*****************************************************************************/
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	367
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	368	/** Initializes an EtherCAT BRD datagram.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	369	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	370	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	371	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	372	int ec_datagram_brd(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	373	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	374	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	375	size_t data_size /*< Number of bytes to read. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	376	)
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	377	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	378	int ret;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	379	EC_FUNC_HEADER;
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 293 diff changeset	380	datagram->type = EC_DATAGRAM_BRD;
708 90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 514 diff changeset	381	EC_WRITE_U16(datagram->address, 0x0000);
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	382	EC_WRITE_U16(datagram->address + 2, mem_address);
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	383	EC_FUNC_FOOTER;
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	384	}
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	385
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	386	/*****************************************************************************/
14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	387
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	388	/** Initializes an EtherCAT BWR datagram.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	389	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	390	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	391	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	392	int ec_datagram_bwr(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	393	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	394	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	395	size_t data_size /*< Number of bytes to write. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	396	)
98 f564d0929292 MERGE branches/async 222:233 -> trunk (Kommando-Warteschlangen). Florian Pose <fp@igh-essen.com> parents: diff changeset	397	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	398	int ret;
293 14aeb79aa992 Renamed command structure to datagram. Florian Pose <fp@igh-essen.com> parents: 246 diff changeset	399	EC_FUNC_HEADER;
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 293 diff changeset	400	datagram->type = EC_DATAGRAM_BWR;
708 90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 514 diff changeset	401	EC_WRITE_U16(datagram->address, 0x0000);
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	402	EC_WRITE_U16(datagram->address + 2, mem_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	403	EC_FUNC_FOOTER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	404	}
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	405
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	406	/*****************************************************************************/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	407
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	408	/** Initializes an EtherCAT BRW datagram.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	409	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	410	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	411	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	412	int ec_datagram_brw(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	413	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	414	uint16_t mem_address, /*< Physical memory address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	415	size_t data_size /*< Number of bytes to write. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	416	)
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	417	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	418	int ret;
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	419	EC_FUNC_HEADER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	420	datagram->type = EC_DATAGRAM_BRW;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	421	EC_WRITE_U16(datagram->address, 0x0000);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	422	EC_WRITE_U16(datagram->address + 2, mem_address);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	423	EC_FUNC_FOOTER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	424	}
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	425
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	426	/*****************************************************************************/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	427
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	428	/** Initializes an EtherCAT LRD datagram.
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	429	*
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	430	* \attention It is assumed, that the external memory is at least \a data_size
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	431	* bytes large.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	432	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	433	* \return Return value of ec_datagram_prealloc().
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	434	*/
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	435	int ec_datagram_lrd(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	436	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	437	uint32_t offset, /*< Logical address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	438	size_t data_size, /*< Number of bytes to read/write. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	439	uint8_t external_memory /< Pointer to the memory to use. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	440	)
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	441	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	442	int ret;
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	443	datagram->data = external_memory;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	444	datagram->data_origin = EC_ORIG_EXTERNAL;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	445	EC_FUNC_HEADER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	446	datagram->type = EC_DATAGRAM_LRD;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	447	EC_WRITE_U32(datagram->address, offset);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	448	EC_FUNC_FOOTER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	449	}
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	450
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	451	/*****************************************************************************/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	452
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	453	/** Initializes an EtherCAT LWR datagram.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	454	*
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	455	* \attention It is assumed, that the external memory is at least \a data_size
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	456	* bytes large.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	457	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	458	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	459	*/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	460	int ec_datagram_lwr(
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	461	ec_datagram_t datagram, /< EtherCAT datagram. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	462	uint32_t offset, /*< Logical address. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	463	size_t data_size, /*< Number of bytes to read/write. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	464	uint8_t external_memory /< Pointer to the memory to use. /
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	465	)
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	466	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	467	int ret;
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	468	datagram->data = external_memory;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	469	datagram->data_origin = EC_ORIG_EXTERNAL;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	470	EC_FUNC_HEADER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	471	datagram->type = EC_DATAGRAM_LWR;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	472	EC_WRITE_U32(datagram->address, offset);
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	473	EC_FUNC_FOOTER;
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	474	}
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	475
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	476	/*****************************************************************************/
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	477
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	478	/** Initializes an EtherCAT LRW datagram.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	479	*
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	480	* \attention It is assumed, that the external memory is at least \a data_size
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	481	* bytes large.
002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	482	*
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	483	* \return Return value of ec_datagram_prealloc().
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	484	*/
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	485	int ec_datagram_lrw(
815 002fe9ec778f Implemented missing datagram types. Florian Pose <fp@igh-essen.com> parents: 809 diff changeset	486	ec_datagram_t datagram, /< EtherCAT datagram. /
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	487	uint32_t offset, /*< Logical address. /
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	488	size_t data_size, /*< Number of bytes to read/write. /
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	489	uint8_t external_memory /< Pointer to the memory to use. /
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	490	)
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	491	{
1313 ed15eef57d5c Improved error case return codes of many functions. Florian Pose <fp@igh-essen.com> parents: 1312 diff changeset	492	int ret;
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	493	datagram->data = external_memory;
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	494	datagram->data_origin = EC_ORIG_EXTERNAL;
144 fdc24bf62f80 Dynamischer Kommandospeicher, Domain-Kommandos als Liste. Florian Pose <fp@igh-essen.com> parents: 104 diff changeset	495	EC_FUNC_HEADER;
325 7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines. Florian Pose <fp@igh-essen.com> parents: 293 diff changeset	496	datagram->type = EC_DATAGRAM_LRW;
708 90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 514 diff changeset	497	EC_WRITE_U32(datagram->address, offset);
90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 514 diff changeset	498	EC_FUNC_FOOTER;
90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 514 diff changeset	499	}
90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 514 diff changeset	500
90bdb315f560 Fixed EtherCAT addressing problem on big-endian systems. The slaves Florian Pose <fp@igh-essen.com> parents: 514 diff changeset	501	/*****************************************************************************/
713 ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	502
1822 74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	503	/** Prints the state of a datagram.
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	504	*
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	505	* Outputs a text message.
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	506	*/
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	507	void ec_datagram_print_state(
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	508	const ec_datagram_t datagram /< EtherCAT datagram /
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	509	)
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	510	{
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	511	printk("Datagram ");
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	512	switch (datagram->state) {
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	513	case EC_DATAGRAM_INIT:
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	514	printk("initialized");
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	515	break;
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	516	case EC_DATAGRAM_QUEUED:
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	517	printk("queued");
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	518	break;
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	519	case EC_DATAGRAM_SENT:
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	520	printk("sent");
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	521	break;
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	522	case EC_DATAGRAM_RECEIVED:
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	523	printk("received");
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	524	break;
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	525	case EC_DATAGRAM_TIMED_OUT:
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	526	printk("timed out");
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	527	break;
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	528	case EC_DATAGRAM_ERROR:
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	529	printk("error");
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	530	break;
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	531	default:
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	532	printk("???");
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	533	}
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	534
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	535	printk(".\n");
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	536	}
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	537
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	538	/*****************************************************************************/
74e6ac2369f4 Introduced ec_datagram_print_state() method and used it at all places where Florian Pose <fp@igh-essen.com> parents: 1553 diff changeset	539
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	540	/** Evaluates the working counter of a single-cast datagram.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	541	*
713 ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	542	* Outputs an error message.
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	543	*/
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	544	void ec_datagram_print_wc_error(
758 8fa6f825eb7d Updated Doxygen documentation. Florian Pose <fp@igh-essen.com> parents: 719 diff changeset	545	const ec_datagram_t datagram /< EtherCAT datagram /
713 ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	546	)
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	547	{
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	548	if (datagram->working_counter == 0)
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	549	printk("No response.");
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	550	else if (datagram->working_counter > 1)
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	551	printk("%u slaves responded!", datagram->working_counter);
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	552	else
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	553	printk("Success.");
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	554	printk("\n");
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	555	}
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	556
ae41cadd25b6 Better handling of unexpected working counters; introduced Florian Pose <fp@igh-essen.com> parents: 708 diff changeset	557	/*****************************************************************************/
719 03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	558
809 ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	559	/** Outputs datagram statistics at most every second.
ec4ef8911824 External domain memory. Florian Pose <fp@igh-essen.com> parents: 758 diff changeset	560	*/
719 03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	561	void ec_datagram_output_stats(
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	562	ec_datagram_t *datagram
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	563	)
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	564	{
2081 9c3fd68997d4 Fixed datagram statistics output (skipped datagrams). Florian Pose <fp@igh-essen.com> parents: 1822 diff changeset	565	if (jiffies - datagram->stats_output_jiffies > HZ) {
719 03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	566	datagram->stats_output_jiffies = jiffies;
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	567
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	568	if (unlikely(datagram->skip_count)) {
1543 373cd456dc26 Avoid warnings on x86_64 platform. Thanks to Thomas Elste. Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	569	EC_WARN("Datagram %p (%s) was SKIPPED %u time%s.\n",
373cd456dc26 Avoid warnings on x86_64 platform. Thanks to Thomas Elste. Florian Pose <fp@igh-essen.com> parents: 1507 diff changeset	570	datagram, datagram->name,
719 03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	571	datagram->skip_count,
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	572	datagram->skip_count == 1 ? "" : "s");
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	573	datagram->skip_count = 0;
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	574	}
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	575	}
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	576	}
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	577
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics Florian Pose <fp@igh-essen.com> parents: 713 diff changeset	578	/*****************************************************************************/
816 d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	579
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	580	/** Returns a string describing the datagram type.
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	581	*/
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	582	const char *ec_datagram_type_string(
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	583	const ec_datagram_t datagram /< EtherCAT datagram. /
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	584	)
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	585	{
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	586	return type_strings[datagram->type];
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	587	}
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	588
d02761e14eb0 Introduced ec_datagram_type_string(). Florian Pose <fp@igh-essen.com> parents: 815 diff changeset	589	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Fri, 08 Jul 2011 14:26:25 +0200
branch	stable-1.5
changeset 2082	775d1a02f204
parent 2081	9c3fd68997d4
child 2099	e485694c6427
permissions	-rw-r--r--