etherlabmaster: tools/Master.cpp@91a0d7226e0b (annotated)

922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1	/*****************************************************************************
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	3	* $Id$
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	5	****************************************************************************/
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	6
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	7	#include <sys/types.h>
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	8	#include <sys/stat.h>
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	9	#include <fcntl.h>
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	10	#include <errno.h>
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	11	#include <sys/ioctl.h>
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	12
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	13	#include <iostream>
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	14	#include <iomanip>
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	15	#include <sstream>
980 c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	16	#include <fstream>
960 36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	17	#include <cctype> // toupper()
988 a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	18	#include <list>
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	19	using namespace std;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	20
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	21	#include "Master.h"
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	22
974 5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	23	#define swap16(x) \
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	24	((uint16_t)( \
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	25	(((uint16_t)(x) & 0x00ffU) << 8) \| \
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	26	(((uint16_t)(x) & 0xff00U) >> 8) ))
974 5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	27	#define swap32(x) \
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	28	((uint32_t)( \
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	29	(((uint32_t)(x) & 0x000000ffUL) << 24) \| \
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	30	(((uint32_t)(x) & 0x0000ff00UL) << 8) \| \
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	31	(((uint32_t)(x) & 0x00ff0000UL) >> 8) \| \
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	32	(((uint32_t)(x) & 0xff000000UL) >> 24) ))
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	33
974 5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	34	#if __BYTE_ORDER == __LITTLE_ENDIAN
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	35
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	36	#define le16tocpu(x) x
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	37	#define le32tocpu(x) x
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	38
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	39	#define cputole16(x) x
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	40	#define cputole32(x) x
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	41
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	42	#elif __BYTE_ORDER == __BIG_ENDIAN
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	43
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	44	#define le16tocpu(x) swap16(x)
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	45	#define le32tocpu(x) swap32(x)
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	46
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	47	#define cputole16(x) swap16(x)
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	48	#define cputole32(x) swap32(x)
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	49
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	50	#endif
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	51
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	52	/****************************************************************************/
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	53
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	54	struct CoEDataType {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	55	const char *name;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	56	uint16_t coeCode;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	57	unsigned int byteSize;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	58	};
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	59
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	60	static const CoEDataType dataTypes[] = {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	61	{"int8", 0x0002, 1},
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	62	{"int16", 0x0003, 2},
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	63	{"int32", 0x0004, 4},
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	64	{"uint8", 0x0005, 1},
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	65	{"uint16", 0x0006, 2},
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	66	{"uint32", 0x0007, 4},
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	67	{"string", 0x0009, 0},
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	68	{"raw", 0xffff, 0},
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	69	{}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	70	};
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	71
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	72	/****************************************************************************/
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	73
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	74	const CoEDataType *findDataType(const string &str)
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	75	{
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	76	const CoEDataType *d;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	77
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	78	for (d = dataTypes; d->name; d++)
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	79	if (str == d->name)
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	80	return d;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	81
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	82	return NULL;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	83	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	84
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	85	/****************************************************************************/
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	86
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	87	const CoEDataType *findDataType(uint16_t code)
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	88	{
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	89	const CoEDataType *d;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	90
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	91	for (d = dataTypes; d->name; d++)
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	92	if (code == d->coeCode)
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	93	return d;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	94
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	95	return NULL;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	96	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	97
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	98	/****************************************************************************/
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	99
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	100	Master::Master()
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	101	{
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	102	index = 0;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	103	fd = -1;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	104	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	105
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	106	/****************************************************************************/
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	107
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	108	Master::~Master()
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	109	{
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	110	close();
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	111	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	112
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	113	/****************************************************************************/
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	114
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	115	void Master::setIndex(unsigned int i)
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	116	{
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	117	index = i;
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	118	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	119
980 c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	120	/*****************************************************************************/
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	121
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	122	/**
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	123	* Writes the Secondary slave address (alias) to the slave's SII.
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	124	*/
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	125	void Master::writeAlias(
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	126	int slavePosition,
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	127	bool force,
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	128	const vector<string> &commandArgs
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	129	)
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	130	{
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	131	ec_ioctl_sii_t data;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	132	ec_ioctl_slave_t slave;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	133	unsigned int i;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	134	uint16_t alias;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	135	stringstream err, strAlias;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	136	int number;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	137
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	138	if (commandArgs.size() != 1) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	139	stringstream err;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	140	err << "'alias' takes exactly one argument!";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	141	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	142	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	143
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	144	strAlias << commandArgs[0];
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	145	strAlias >> hex >> number;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	146	if (strAlias.fail() \|\| number < 0x0000 \|\| number > 0xffff) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	147	err << "Invalid alias '" << commandArgs[0] << "'!";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	148	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	149	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	150	alias = number;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	151
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	152	if (slavePosition == -1) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	153	unsigned int numSlaves, i;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	154
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	155	if (!force) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	156	err << "This will write the alias addresses of all slaves to 0x"
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	157	<< hex << setfill('0') << setw(4) << alias << "! "
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	158	<< "Please specify --force to proceed.";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	159	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	160	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	161
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	162	open(ReadWrite);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	163	numSlaves = slaveCount();
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	164
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	165	for (i = 0; i < numSlaves; i++) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	166	writeSlaveAlias(i, alias);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	167	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	168	} else {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	169	open(ReadWrite);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	170	writeSlaveAlias(slavePosition, alias);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	171	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	172	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	173
990 4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	174	/*****************************************************************************/
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	175
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	176	/**
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	177	* Lists the bus configuration.
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	178	*/
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	179	void Master::showConfig()
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	180	{
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	181	ec_ioctl_master_t master;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	182	unsigned int i, j, k, l;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	183	ec_ioctl_config_t config;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	184	ec_ioctl_config_pdo_t pdo;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	185	ec_ioctl_config_pdo_entry_t entry;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	186	ec_ioctl_config_sdo_t sdo;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	187
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	188	open(Read);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	189	getMaster(&master);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	190
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	191	for (i = 0; i < master.config_count; i++) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	192	getConfig(&config, i);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	193
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	194	cout << "Alias: 0x"
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	195	<< hex << setfill('0') << setw(4) << config.alias << endl
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	196	<< "Position: " << dec << config.position << endl
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	197	<< "Vendor Id: 0x"
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	198	<< hex << setw(8) << config.vendor_id << endl
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	199	<< "Product code: 0x"
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	200	<< hex << setw(8) << config.product_code << endl
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	201	<< "Attached: " << (config.attached ? "yes" : "no") << endl;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	202
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	203	for (j = 0; j < 2; j++) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	204	if (config.pdo_count[j]) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	205	cout << (j ? "Input" : "Output")
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	206	<< " Pdo assignment / mapping " << endl;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	207	for (k = 0; k < config.pdo_count[j]; k++) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	208	getConfigPdo(&pdo, i, j, k);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	209
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	210	cout << " Pdo 0x"
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	211	<< hex << setfill('0') << setw(4) << pdo.index
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	212	<< " \"" << pdo.name << "\"" << endl;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	213
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	214	for (l = 0; l < pdo.entry_count; l++) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	215	getConfigPdoEntry(&entry, i, j, k, l);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	216
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	217	cout << " Pdo entry 0x"
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	218	<< hex << setfill('0') << setw(4) << entry.index
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	219	<< ":" << setw(2) << (unsigned int) entry.subindex
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	220	<< ", " << dec << (unsigned int) entry.bit_length
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	221	<< " bit, \"" << entry.name << "\"" << endl;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	222	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	223	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	224	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	225	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	226
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	227	if (config.sdo_count) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	228	cout << "Sdo configuration:" << endl;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	229	for (j = 0; j < config.sdo_count; j++) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	230	getConfigSdo(&sdo, i, j);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	231
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	232	cout << " 0x"
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	233	<< hex << setfill('0') << setw(4) << sdo.index
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	234	<< ":" << setw(2) << (unsigned int) sdo.subindex
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	235	<< ", " << sdo.size << " byte: " << hex;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	236
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	237	switch (sdo.size) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	238	case 1:
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	239	cout << "0x" << setw(2)
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	240	<< (unsigned int) (uint8_t ) &sdo.data;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	241	break;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	242	case 2:
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	243	cout << "0x" << setw(4)
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	244	<< le16tocpu((uint16_t ) &sdo.data);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	245	break;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	246	case 4:
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	247	cout << "0x" << setw(8)
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	248	<< le32tocpu((uint32_t ) &sdo.data);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	249	break;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	250	default:
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	251	cout << "???";
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	252	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	253
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	254	cout << endl;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	255	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	256	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	257
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	258	cout << endl;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	259	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	260	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	261
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	262	/****************************************************************************/
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	263
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	264	void Master::outputData(int domainIndex)
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	265	{
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	266	open(Read);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	267
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	268	if (domainIndex == -1) {
1001 a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	269	unsigned int i;
a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	270	ec_ioctl_master_t master;
a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	271
a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	272	getMaster(&master);
a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	273
a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	274	for (i = 0; i < master.domain_count; i++) {
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	275	outputDomainData(i);
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	276	}
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	277	} else {
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	278	outputDomainData(domainIndex);
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	279	}
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	280	}
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	281
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	282	/****************************************************************************/
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	283
956 d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	284	void Master::setDebug(const vector<string> &commandArgs)
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	285	{
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	286	stringstream str;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	287	int debugLevel;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	288
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	289	if (commandArgs.size() != 1) {
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	290	stringstream err;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	291	err << "'debug' takes exactly one argument!";
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	292	throw MasterException(err.str());
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	293	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	294
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	295	str << commandArgs[0];
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	296	str >> debugLevel;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	297
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	298	if (str.fail()) {
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	299	stringstream err;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	300	err << "Invalid debug level '" << commandArgs[0] << "'!";
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	301	throw MasterException(err.str());
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	302	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	303
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	304	open(ReadWrite);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	305
957 ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	306	if (ioctl(fd, EC_IOCTL_SET_DEBUG, debugLevel) < 0) {
956 d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	307	stringstream err;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	308	err << "Failed to set debug level: " << strerror(errno);
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	309	throw MasterException(err.str());
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	310	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	311	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	312
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	313	/****************************************************************************/
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	314
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	315	void Master::showDomains(int domainIndex)
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	316	{
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	317	open(Read);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	318
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	319	if (domainIndex == -1) {
1001 a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	320	unsigned int i;
a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	321	ec_ioctl_master_t master;
a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	322
a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	323	getMaster(&master);
a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	324
a8eab75aa8e3 Removed EC_IOCTL_DOMAIN_COUNT. Florian Pose <fp@igh-essen.com> parents: 990 diff changeset	325	for (i = 0; i < master.domain_count; i++) {
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	326	showDomain(i);
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	327	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	328	} else {
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	329	showDomain(domainIndex);
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	330	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	331	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	332
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	333	/****************************************************************************/
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	334
988 a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	335	struct SlaveInfo {
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	336	string pos;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	337	string alias;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	338	string relPos;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	339	string state;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	340	string flag;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	341	string name;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	342	};
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	343
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	344	void Master::listSlaves()
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	345	{
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	346	unsigned int numSlaves, i;
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	347	ec_ioctl_slave_t slave;
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	348	uint16_t lastAlias, aliasIndex;
988 a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	349	SlaveInfo slaveInfo;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	350	typedef list<SlaveInfo> SlaveInfoList;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	351	SlaveInfoList slaveInfoList;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	352	SlaveInfoList::const_iterator iter;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	353	stringstream str;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	354	unsigned int maxPosWidth = 0, maxAliasWidth = 0,
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	355	maxRelPosWidth = 0, maxStateWidth = 0;
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	356
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	357	open(Read);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	358
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	359	numSlaves = slaveCount();
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	360
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	361	lastAlias = 0;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	362	aliasIndex = 0;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	363	for (i = 0; i < numSlaves; i++) {
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	364	getSlave(&slave, i);
988 a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	365
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	366	str << dec << i;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	367	slaveInfo.pos = str.str();
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	368	str.clear();
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	369	str.str("");
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	370
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	371	if (slave.alias) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	372	lastAlias = slave.alias;
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	373	aliasIndex = 0;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	374	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	375	if (lastAlias) {
988 a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	376	str << "#" << hex << lastAlias;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	377	slaveInfo.alias = str.str();
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	378	str.str("");
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	379	str << ":" << dec << aliasIndex;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	380	slaveInfo.relPos = str.str();
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	381	str.str("");
980 c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	382	aliasIndex++;
988 a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	383	} else {
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	384	slaveInfo.alias = "";
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	385	slaveInfo.relPos = "";
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	386	}
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	387
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	388	slaveInfo.state = slaveState(slave.state);
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	389	slaveInfo.flag = (slave.error_flag ? 'E' : '+');
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	390
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	391	if (strlen(slave.name)) {
988 a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	392	slaveInfo.name = slave.name;
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	393	} else {
988 a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	394	str << hex << setfill('0')
980 c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	395	<< setw(8) << slave.vendor_id << ":"
988 a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	396	<< setw(8) << slave.product_code;
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	397	slaveInfo.name = str.str();
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	398	str.str("");
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	399	}
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	400
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	401	slaveInfoList.push_back(slaveInfo);
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	402	if (slaveInfo.pos.length() > maxPosWidth)
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	403	maxPosWidth = slaveInfo.pos.length();
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	404	if (slaveInfo.alias.length() > maxAliasWidth)
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	405	maxAliasWidth = slaveInfo.alias.length();
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	406	if (slaveInfo.relPos.length() > maxRelPosWidth)
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	407	maxRelPosWidth = slaveInfo.relPos.length();
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	408	if (slaveInfo.state.length() > maxStateWidth)
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	409	maxStateWidth = slaveInfo.state.length();
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	410	}
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	411
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	412	for (iter = slaveInfoList.begin(); iter != slaveInfoList.end(); iter++) {
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	413	cout << setfill(' ') << right
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	414	<< setw(maxPosWidth) << iter->pos << " "
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	415	<< setw(maxAliasWidth) << iter->alias
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	416	<< left
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	417	<< setw(maxRelPosWidth) << iter->relPos << " "
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	418	<< setw(maxStateWidth) << iter->state << " "
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	419	<< iter->flag << " "
a47c5a3c143d Improved 'ethercat ls' formatting. Florian Pose <fp@igh-essen.com> parents: 987 diff changeset	420	<< iter->name << endl;
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	421	}
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	422	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	423
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	424	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	425
957 ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	426	void Master::showMaster()
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	427	{
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	428	ec_ioctl_master_t data;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	429	stringstream err;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	430	unsigned int i;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	431
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	432	open(Read);
957 ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	433	getMaster(&data);
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	434
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	435	cout
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	436	<< "Master" << index << endl
1029 61ffe5f22306 Renamed master 'mode' to 'phase'. Florian Pose <fp@igh-essen.com> parents: 1001 diff changeset	437	<< " Phase: ";
61ffe5f22306 Renamed master 'mode' to 'phase'. Florian Pose <fp@igh-essen.com> parents: 1001 diff changeset	438
61ffe5f22306 Renamed master 'mode' to 'phase'. Florian Pose <fp@igh-essen.com> parents: 1001 diff changeset	439	switch (data.phase) {
957 ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	440	case 0: cout << "Waiting for device..."; break;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	441	case 1: cout << "Idle"; break;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	442	case 2: cout << "Operation"; break;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	443	default:
1029 61ffe5f22306 Renamed master 'mode' to 'phase'. Florian Pose <fp@igh-essen.com> parents: 1001 diff changeset	444	err << "Invalid master phase " << data.phase;
957 ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	445	throw MasterException(err.str());
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	446	}
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	447
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	448	cout << endl
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	449	<< " Slaves: " << data.slave_count << endl;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	450
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	451	for (i = 0; i < 2; i++) {
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	452	cout << " Device" << i << ": ";
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	453	if (data.devices[i].address[0] == 0x00
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	454	&& data.devices[i].address[1] == 0x00
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	455	&& data.devices[i].address[2] == 0x00
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	456	&& data.devices[i].address[3] == 0x00
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	457	&& data.devices[i].address[4] == 0x00
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	458	&& data.devices[i].address[5] == 0x00) {
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	459	cout << "None.";
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	460	} else {
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	461	cout << hex << setfill('0')
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	462	<< setw(2) << (unsigned int) data.devices[i].address[0] << ":"
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	463	<< setw(2) << (unsigned int) data.devices[i].address[1] << ":"
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	464	<< setw(2) << (unsigned int) data.devices[i].address[2] << ":"
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	465	<< setw(2) << (unsigned int) data.devices[i].address[3] << ":"
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	466	<< setw(2) << (unsigned int) data.devices[i].address[4] << ":"
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	467	<< setw(2) << (unsigned int) data.devices[i].address[5] << " ("
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	468	<< (data.devices[i].attached ? "attached" : "waiting...")
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	469	<< ")" << endl << dec
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	470	<< " Tx count: " << data.devices[i].tx_count << endl
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	471	<< " Rx count: " << data.devices[i].rx_count;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	472	}
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	473	cout << endl;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	474	}
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	475	}
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	476
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	477	/****************************************************************************/
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	478
966 f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	479	void Master::listPdos(int slavePosition, bool quiet)
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	480	{
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	481	open(Read);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	482
936 30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	483	if (slavePosition == -1) {
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	484	unsigned int numSlaves = slaveCount(), i;
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	485
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	486	for (i = 0; i < numSlaves; i++) {
966 f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	487	listSlavePdos(i, quiet, true);
936 30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	488	}
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	489	} else {
966 f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	490	listSlavePdos(slavePosition, quiet, false);
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	491	}
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	492	}
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	493
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	494	/****************************************************************************/
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	495
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	496	void Master::listSdos(int slavePosition, bool quiet)
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	497	{
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	498	open(Read);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	499
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	500	if (slavePosition == -1) {
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	501	unsigned int numSlaves = slaveCount(), i;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	502
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	503	for (i = 0; i < numSlaves; i++) {
966 f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	504	listSlaveSdos(i, quiet, true);
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	505	}
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	506	} else {
966 f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	507	listSlaveSdos(slavePosition, quiet, false);
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	508	}
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	509	}
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	510
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	511	/****************************************************************************/
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	512
974 5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	513	void Master::sdoDownload(
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	514	int slavePosition,
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	515	const string &dataTypeStr,
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	516	const vector<string> &commandArgs
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	517	)
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	518	{
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	519	stringstream strIndex, strSubIndex, strValue, err;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	520	int number, sval;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	521	ec_ioctl_sdo_download_t data;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	522	unsigned int i, uval;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	523	const CoEDataType *dataType = NULL;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	524
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	525	if (slavePosition < 0) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	526	err << "'sdo_download' requires a slave! Please specify --slave.";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	527	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	528	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	529	data.slave_position = slavePosition;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	530
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	531	if (commandArgs.size() != 3) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	532	err << "'sdo_download' takes 3 arguments!";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	533	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	534	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	535
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	536	strIndex << commandArgs[0];
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	537	strIndex >> hex >> number;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	538	if (strIndex.fail() \|\| number < 0x0000 \|\| number > 0xffff) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	539	err << "Invalid Sdo index '" << commandArgs[0] << "'!";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	540	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	541	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	542	data.sdo_index = number;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	543
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	544	strSubIndex << commandArgs[1];
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	545	strSubIndex >> hex >> number;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	546	if (strSubIndex.fail() \|\| number < 0x00 \|\| number > 0xff) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	547	err << "Invalid Sdo subindex '" << commandArgs[1] << "'!";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	548	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	549	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	550	data.sdo_entry_subindex = number;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	551
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	552	if (dataTypeStr != "") { // data type specified
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	553	if (!(dataType = findDataType(dataTypeStr))) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	554	err << "Invalid data type '" << dataTypeStr << "'!";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	555	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	556	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	557	} else { // no data type specified: fetch from dictionary
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	558	ec_ioctl_sdo_entry_t entry;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	559	unsigned int entryByteSize;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	560
982 861eb2810f56 Open device with correct permissions immediately. Florian Pose <fp@igh-essen.com> parents: 980 diff changeset	561	open(ReadWrite);
974 5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	562
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	563	try {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	564	getSdoEntry(&entry, slavePosition,
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	565	data.sdo_index, data.sdo_entry_subindex);
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	566	} catch (MasterException &e) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	567	err << "Failed to determine Sdo entry data type. "
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	568	<< "Please specify --type.";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	569	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	570	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	571	if (!(dataType = findDataType(entry.data_type))) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	572	err << "Pdo entry has unknown data type 0x"
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	573	<< hex << setfill('0') << setw(4) << entry.data_type << "!"
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	574	<< " Please specify --type.";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	575	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	576	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	577	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	578
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	579	if (dataType->byteSize) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	580	data.data_size = dataType->byteSize;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	581	} else {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	582	data.data_size = DefaultBufferSize;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	583	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	584
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	585	data.data = new uint8_t[data.data_size + 1];
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	586
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	587	strValue << commandArgs[2];
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	588
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	589	switch (dataType->coeCode) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	590	case 0x0002: // int8
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	591	strValue >> sval;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	592	if ((uint32_t) sval > 0xff) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	593	delete [] data.data;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	594	err << "Invalid value for type '"
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	595	<< dataType->name << "'!";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	596	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	597	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	598	*data.data = (int8_t) sval;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	599	break;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	600	case 0x0003: // int16
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	601	strValue >> sval;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	602	if ((uint32_t) sval > 0xffff) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	603	delete [] data.data;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	604	err << "Invalid value for type '"
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	605	<< dataType->name << "'!";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	606	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	607	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	608	(int16_t ) data.data = cputole16(sval);
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	609	break;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	610	case 0x0004: // int32
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	611	strValue >> sval;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	612	(int32_t ) data.data = cputole32(sval);
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	613	break;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	614	case 0x0005: // uint8
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	615	strValue >> uval;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	616	if ((uint32_t) uval > 0xff) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	617	delete [] data.data;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	618	err << "Invalid value for type '"
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	619	<< dataType->name << "'!";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	620	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	621	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	622	*data.data = (uint8_t) uval;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	623	break;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	624	case 0x0006: // uint16
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	625	strValue >> uval;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	626	if ((uint32_t) uval > 0xffff) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	627	delete [] data.data;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	628	err << "Invalid value for type '"
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	629	<< dataType->name << "'!";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	630	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	631	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	632	(uint16_t ) data.data = cputole16(uval);
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	633	break;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	634	case 0x0007: // uint32
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	635	strValue >> uval;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	636	(uint32_t ) data.data = cputole32(uval);
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	637	break;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	638	case 0x0009: // string
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	639	if (strValue.str().size() >= data.data_size) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	640	err << "String too big";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	641	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	642	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	643	data.data_size = strValue.str().size();
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	644	strValue >> (char *) data.data;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	645	break;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	646	default:
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	647	break;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	648	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	649
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	650	if (strValue.fail()) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	651	err << "Invalid value argument '" << commandArgs[2] << "'!";
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	652	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	653	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	654
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	655	open(ReadWrite);
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	656
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	657	if (ioctl(fd, EC_IOCTL_SDO_DOWNLOAD, &data) < 0) {
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	658	stringstream err;
1037 59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	659	err << "Failed to download Sdo: ";
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	660	if (errno == EIO && data.abort_code) {
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	661	err << "Abort code 0x" << hex << setfill('0') << setw(8)
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	662	<< data.abort_code;
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	663	} else {
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	664	err << strerror(errno);
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	665	}
974 5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	666	delete [] data.data;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	667	throw MasterException(err.str());
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	668	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	669
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	670	delete [] data.data;
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	671	}
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	672
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	673	/****************************************************************************/
5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	674
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	675	void Master::sdoUpload(
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	676	int slavePosition,
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	677	const string &dataTypeStr,
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	678	const vector<string> &commandArgs
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	679	)
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	680	{
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	681	stringstream strIndex, strSubIndex;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	682	int number, sval;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	683	ec_ioctl_sdo_upload_t data;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	684	unsigned int i, uval;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	685	const CoEDataType *dataType = NULL;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	686
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	687	if (slavePosition < 0) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	688	stringstream err;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	689	err << "'sdo_upload' requires a slave! Please specify --slave.";
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	690	throw MasterException(err.str());
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	691	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	692	data.slave_position = slavePosition;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	693
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	694	if (commandArgs.size() != 2) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	695	stringstream err;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	696	err << "'sdo_upload' takes two arguments!";
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	697	throw MasterException(err.str());
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	698	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	699
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	700	strIndex << commandArgs[0];
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	701	strIndex >> hex >> number;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	702	if (strIndex.fail() \|\| number < 0x0000 \|\| number > 0xffff) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	703	stringstream err;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	704	err << "Invalid Sdo index '" << commandArgs[0] << "'!";
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	705	throw MasterException(err.str());
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	706	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	707	data.sdo_index = number;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	708
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	709	strSubIndex << commandArgs[1];
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	710	strSubIndex >> hex >> number;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	711	if (strSubIndex.fail() \|\| number < 0x00 \|\| number > 0xff) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	712	stringstream err;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	713	err << "Invalid Sdo subindex '" << commandArgs[1] << "'!";
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	714	throw MasterException(err.str());
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	715	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	716	data.sdo_entry_subindex = number;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	717
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	718	if (dataTypeStr != "") { // data type specified
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	719	if (!(dataType = findDataType(dataTypeStr))) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	720	stringstream err;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	721	err << "Invalid data type '" << dataTypeStr << "'!";
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	722	throw MasterException(err.str());
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	723	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	724	} else { // no data type specified: fetch from dictionary
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	725	ec_ioctl_sdo_entry_t entry;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	726	unsigned int entryByteSize;
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	727
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	728	open(Read);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	729
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	730	try {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	731	getSdoEntry(&entry, slavePosition,
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	732	data.sdo_index, data.sdo_entry_subindex);
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	733	} catch (MasterException &e) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	734	stringstream err;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	735	err << "Failed to determine Sdo entry data type. "
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	736	<< "Please specify --type.";
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	737	throw MasterException(err.str());
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	738	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	739	if (!(dataType = findDataType(entry.data_type))) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	740	stringstream err;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	741	err << "Pdo entry has unknown data type 0x"
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	742	<< hex << setfill('0') << setw(4) << entry.data_type << "!"
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	743	<< " Please specify --type.";
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	744	throw MasterException(err.str());
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	745	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	746	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	747
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	748	if (dataType->byteSize) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	749	data.target_size = dataType->byteSize;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	750	} else {
974 5868944a6456 Implemented Sdo download via ethercat command. Florian Pose <fp@igh-essen.com> parents: 972 diff changeset	751	data.target_size = DefaultBufferSize;
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	752	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	753
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	754	data.target = new uint8_t[data.target_size + 1];
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	755
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	756	open(Read);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	757
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	758	if (ioctl(fd, EC_IOCTL_SDO_UPLOAD, &data) < 0) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	759	stringstream err;
1037 59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	760	err << "Failed to upload Sdo: ";
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	761	if (errno == EIO && data.abort_code) {
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	762	err << "Abort code 0x" << hex << setfill('0') << setw(8)
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	763	<< data.abort_code;
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	764	} else {
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	765	err << strerror(errno);
59f191c9185b Store abort code in sdo request; output it in user space; added some Florian Pose <fp@igh-essen.com> parents: 1030 diff changeset	766	}
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	767	delete [] data.target;
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	768	close();
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	769	throw MasterException(err.str());
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	770	}
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	771
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	772	close();
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	773
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	774	if (dataType->byteSize && data.data_size != dataType->byteSize) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	775	stringstream err;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	776	err << "Data type mismatch. Expected " << dataType->name
970 b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	777	<< " with " << dataType->byteSize << " byte, but got "
b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	778	<< data.data_size << " byte.";
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	779	throw MasterException(err.str());
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	780	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	781
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	782	cout << setfill('0');
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	783	switch (dataType->coeCode) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	784	case 0x0002: // int8
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	785	sval = (int8_t ) data.target;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	786	cout << sval << " 0x" << hex << setw(2) << sval << endl;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	787	break;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	788	case 0x0003: // int16
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	789	sval = le16tocpu((int16_t ) data.target);
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	790	cout << sval << " 0x" << hex << setw(4) << sval << endl;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	791	break;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	792	case 0x0004: // int32
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	793	sval = le32tocpu((int32_t ) data.target);
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	794	cout << sval << " 0x" << hex << setw(8) << sval << endl;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	795	break;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	796	case 0x0005: // uint8
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	797	uval = (unsigned int) (uint8_t ) data.target;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	798	cout << uval << " 0x" << hex << setw(2) << uval << endl;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	799	break;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	800	case 0x0006: // uint16
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	801	uval = le16tocpu((uint16_t ) data.target);
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	802	cout << uval << " 0x" << hex << setw(4) << uval << endl;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	803	break;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	804	case 0x0007: // uint32
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	805	uval = le32tocpu((uint32_t ) data.target);
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	806	cout << uval << " 0x" << hex << setw(8) << uval << endl;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	807	break;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	808	case 0x0009: // string
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	809	cout << string((const char *) data.target, data.data_size)
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	810	<< endl;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	811	break;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	812	default:
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	813	printRawData(data.target, data.data_size);
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	814	break;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	815	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	816
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	817	delete [] data.target;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	818	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	819
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	820	/****************************************************************************/
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	821
989 816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	822	void Master::showSlaves(int slavePosition)
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	823	{
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	824	open(Read);
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	825
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	826	if (slavePosition == -1) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	827	unsigned int numSlaves = slaveCount(), i;
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	828
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	829	for (i = 0; i < numSlaves; i++) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	830	showSlave(i);
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	831	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	832	} else {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	833	showSlave(slavePosition);
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	834	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	835	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	836
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	837	/****************************************************************************/
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	838
978 2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	839	void Master::siiRead(int slavePosition)
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	840	{
980 c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	841	ec_ioctl_sii_t data;
978 2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	842	ec_ioctl_slave_t slave;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	843	unsigned int i;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	844
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	845	if (slavePosition < 0) {
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	846	stringstream err;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	847	err << "'sii_read' requires a slave! Please specify --slave.";
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	848	throw MasterException(err.str());
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	849	}
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	850	data.slave_position = slavePosition;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	851
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	852	open(Read);
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	853
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	854	getSlave(&slave, slavePosition);
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	855
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	856	if (!slave.sii_nwords)
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	857	return;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	858
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	859	data.offset = 0;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	860	data.nwords = slave.sii_nwords;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	861	data.words = new uint16_t[data.nwords];
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	862
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	863	if (ioctl(fd, EC_IOCTL_SII_READ, &data) < 0) {
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	864	stringstream err;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	865	delete [] data.words;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	866	err << "Failed to read SII: " << strerror(errno);
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	867	throw MasterException(err.str());
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	868	}
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	869
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	870	for (i = 0; i < data.nwords; i++) {
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	871	uint16_t *w = data.words + i;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	872	cout << (uint8_t ) w << ((uint8_t ) w + 1);
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	873	}
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	874
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	875	delete [] data.words;
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	876	}
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	877
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	878	/****************************************************************************/
2962baf7e6d1 Implemented SII read. Florian Pose <fp@igh-essen.com> parents: 976 diff changeset	879
980 c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	880	void Master::siiWrite(
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	881	int slavePosition,
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	882	bool force,
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	883	const vector<string> &commandArgs
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	884	)
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	885	{
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	886	stringstream err;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	887	ec_ioctl_sii_t data;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	888	ifstream file;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	889	unsigned int byte_size;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	890	const uint16_t *categoryHeader;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	891	uint16_t categoryType, categorySize;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	892	uint8_t crc;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	893
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	894	if (slavePosition < 0) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	895	err << "'sii_write' requires a slave! Please specify --slave.";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	896	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	897	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	898	data.slave_position = slavePosition;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	899
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	900	if (commandArgs.size() != 1) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	901	err << "'ssi_write' takes exactly one argument!";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	902	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	903	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	904
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	905	file.open(commandArgs[0].c_str(), ifstream::in \| ifstream::binary);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	906	if (file.fail()) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	907	err << "Failed to open '" << commandArgs[0] << "'!";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	908	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	909	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	910
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	911	// get length of file
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	912	file.seekg(0, ios::end);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	913	byte_size = file.tellg();
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	914	file.seekg(0, ios::beg);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	915
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	916	if (!byte_size \|\| byte_size % 2) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	917	stringstream err;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	918	err << "Invalid file size! Must be non-zero and even.";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	919	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	920	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	921
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	922	data.nwords = byte_size / 2;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	923	if (data.nwords < 0x0041 && !force) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	924	err << "SII data too short (" << data.nwords << " words)! Mimimum is"
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	925	" 40 fixed words + 1 delimiter. Use --force to write anyway.";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	926	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	927	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	928
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	929	// allocate buffer and read file into buffer
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	930	data.words = new uint16_t[data.nwords];
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	931	file.read((char *) data.words, byte_size);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	932	file.close();
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	933
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	934	if (!force) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	935	// calculate checksum over words 0 to 6
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	936	crc = calcSiiCrc((const uint8_t *) data.words, 14);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	937	if (crc != ((const uint8_t *) data.words)[14]) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	938	err << "CRC incorrect. Must be 0x"
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	939	<< hex << setfill('0') << setw(2) << (unsigned int) crc
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	940	<< ". Use --force to write anyway.";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	941	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	942	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	943
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	944	// cycle through categories to detect corruption
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	945	categoryHeader = data.words + 0x0040;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	946	categoryType = le16tocpu(*categoryHeader);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	947	while (categoryType != 0xffff) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	948	if (categoryHeader + 1 > data.words + data.nwords) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	949	err << "SII data seem to be corrupted! "
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	950	<< "Use --force to write anyway.";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	951	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	952	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	953	categorySize = le16tocpu(*(categoryHeader + 1));
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	954	if (categoryHeader + categorySize + 2 > data.words + data.nwords) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	955	err << "SII data seem to be corrupted! "
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	956	"Use --force to write anyway.";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	957	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	958	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	959	categoryHeader += categorySize + 2;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	960	categoryType = le16tocpu(*categoryHeader);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	961	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	962	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	963
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	964	// send data to master
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	965	open(ReadWrite);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	966	data.offset = 0;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	967	if (ioctl(fd, EC_IOCTL_SII_WRITE, &data) < 0) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	968	stringstream err;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	969	err << "Failed to write SII: " << strerror(errno);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	970	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	971	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	972	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	973
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	974	/****************************************************************************/
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	975
960 36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	976	void Master::requestStates(
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	977	int slavePosition,
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	978	const vector<string> &commandArgs
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	979	)
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	980	{
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	981	string stateStr;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	982	uint8_t state;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	983
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	984	if (commandArgs.size() != 1) {
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	985	stringstream err;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	986	err << "'state' takes exactly one argument!";
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	987	throw MasterException(err.str());
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	988	}
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	989
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	990	stateStr = commandArgs[0];
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	991	transform(stateStr.begin(), stateStr.end(),
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	992	stateStr.begin(), (int (*) (int)) std::toupper);
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	993
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	994	if (stateStr == "INIT") {
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	995	state = 0x01;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	996	} else if (stateStr == "PREOP") {
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	997	state = 0x02;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	998	} else if (stateStr == "SAFEOP") {
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	999	state = 0x04;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1000	} else if (stateStr == "OP") {
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1001	state = 0x08;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1002	} else {
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1003	stringstream err;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1004	err << "Invalid state '" << commandArgs[0] << "'!";
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1005	throw MasterException(err.str());
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1006	}
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1007
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1008	open(ReadWrite);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1009
960 36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1010	if (slavePosition == -1) {
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1011	unsigned int i, numSlaves = slaveCount();
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1012	for (i = 0; i < numSlaves; i++)
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1013	requestState(i, state);
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1014	} else {
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1015	requestState(slavePosition, state);
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1016	}
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1017	}
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1018
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1019	/****************************************************************************/
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1020
938 5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1021	void Master::generateXml(int slavePosition)
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1022	{
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1023	open(Read);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1024
938 5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1025	if (slavePosition == -1) {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1026	unsigned int numSlaves = slaveCount(), i;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1027
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1028	for (i = 0; i < numSlaves; i++) {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1029	generateSlaveXml(i);
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1030	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1031	} else {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1032	generateSlaveXml(slavePosition);
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1033	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1034	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1035
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1036	/****************************************************************************/
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1037
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1038	void Master::open(Permissions perm)
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1039	{
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1040	stringstream deviceName;
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1041
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1042	if (fd != -1) { // already open
982 861eb2810f56 Open device with correct permissions immediately. Florian Pose <fp@igh-essen.com> parents: 980 diff changeset	1043	return;
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1044	}
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1045
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1046	deviceName << "/dev/EtherCAT" << index;
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1047
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1048	if ((fd = ::open(deviceName.str().c_str(),
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1049	perm == ReadWrite ? O_RDWR : O_RDONLY)) == -1) {
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1050	stringstream err;
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1051	err << "Failed to open master device " << deviceName.str() << ": "
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1052	<< strerror(errno);
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1053	throw MasterException(err.str());
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1054	}
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1055	}
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1056
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1057	/****************************************************************************/
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1058
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1059	void Master::close()
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1060	{
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1061	if (fd == -1)
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1062	return;
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1063
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1064	::close(fd);
982 861eb2810f56 Open device with correct permissions immediately. Florian Pose <fp@igh-essen.com> parents: 980 diff changeset	1065	fd = -1;
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1066	}
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1067
980 c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1068	/*****************************************************************************/
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1069
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1070	/**
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1071	* Writes the Secondary slave address (alias) to the slave's SII.
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1072	*/
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1073	void Master::writeSlaveAlias(
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1074	uint16_t slavePosition,
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1075	uint16_t alias
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1076	)
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1077	{
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1078	ec_ioctl_sii_t data;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1079	ec_ioctl_slave_t slave;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1080	stringstream err;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1081	uint8_t crc;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1082
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1083	open(ReadWrite);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1084
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1085	getSlave(&slave, slavePosition);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1086
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1087	if (slave.sii_nwords < 8) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1088	err << "Current SII contents are too small to set an alias "
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1089	<< "(" << slave.sii_nwords << " words)!";
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1090	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1091	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1092
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1093	data.slave_position = slavePosition;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1094	data.offset = 0;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1095	data.nwords = 8;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1096	data.words = new uint16_t[data.nwords];
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1097
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1098	// read first 8 SII words
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1099	if (ioctl(fd, EC_IOCTL_SII_READ, &data) < 0) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1100	delete [] data.words;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1101	err << "Failed to read SII: " << strerror(errno);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1102	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1103	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1104
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1105	// write new alias address in word 4
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1106	data.words[4] = cputole16(alias);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1107
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1108	// calculate checksum over words 0 to 6
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1109	crc = calcSiiCrc((const uint8_t *) data.words, 14);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1110
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1111	// write new checksum into first byte of word 7
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1112	(uint8_t ) (data.words + 7) = crc;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1113
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1114	// write first 8 words with new alias and checksum
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1115	if (ioctl(fd, EC_IOCTL_SII_WRITE, &data) < 0) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1116	delete [] data.words;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1117	err << "Failed to write SII: " << strerror(errno);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1118	throw MasterException(err.str());
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1119	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1120
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1121	delete [] data.words;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1122	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1123
972 ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1124	/****************************************************************************/
ad59641a68c8 ioctl() permissions. Florian Pose <fp@igh-essen.com> parents: 970 diff changeset	1125
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1126	void Master::outputDomainData(unsigned int domainIndex)
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1127	{
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1128	ec_ioctl_domain_t domain;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1129	ec_ioctl_data_t data;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1130	unsigned char *processData;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1131	unsigned int i;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1132
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1133	getDomain(&domain, domainIndex);
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1134
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1135	if (!domain.data_size)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1136	return;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1137
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1138	processData = new unsigned char[domain.data_size];
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1139
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1140	try {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1141	getData(&data, domainIndex, domain.data_size, processData);
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1142	} catch (MasterException &e) {
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1143	delete [] processData;
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1144	throw e;
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1145	}
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1146
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1147	for (i = 0; i < data.data_size; i++)
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1148	cout << processData[i];
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1149	cout.flush();
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1150
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1151	delete [] processData;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1152	}
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1153
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1154	/****************************************************************************/
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	1155
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1156	void Master::showDomain(unsigned int domainIndex)
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1157	{
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1158	ec_ioctl_domain_t domain;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1159	unsigned char *processData;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1160	ec_ioctl_data_t data;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1161	unsigned int i, j;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1162	ec_ioctl_domain_fmmu_t fmmu;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1163	unsigned int dataOffset;
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1164
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1165	getDomain(&domain, domainIndex);
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1166
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1167	cout << "Domain" << domainIndex << ":"
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1168	<< " LogBaseAddr 0x"
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1169	<< hex << setfill('0') << setw(8) << domain.logical_base_address
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1170	<< ", Size " << dec << setfill(' ') << setw(3) << domain.data_size
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1171	<< ", WorkingCounter "
951 dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	1172	<< dec << domain.working_counter << "/"
dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	1173	<< domain.expected_working_counter << endl;
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1174
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1175	if (!domain.data_size)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1176	return;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1177
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1178	processData = new unsigned char[domain.data_size];
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1179
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1180	try {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1181	getData(&data, domainIndex, domain.data_size, processData);
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1182	} catch (MasterException &e) {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1183	delete [] processData;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1184	throw e;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1185	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1186
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1187	for (i = 0; i < domain.fmmu_count; i++) {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1188	getFmmu(&fmmu, domainIndex, i);
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1189
951 dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	1190	cout << " SlaveConfig "
dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	1191	<< fmmu.slave_config_alias << ":" << fmmu.slave_config_position
dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	1192	<< ", Dir "
dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	1193	<< setfill(' ') << setw(3) << (fmmu.fmmu_dir ? "In" : "Out")
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1194	<< ", LogAddr 0x"
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1195	<< hex << setfill('0') << setw(8) << fmmu.logical_address
951 dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	1196	<< ", Size " << dec << fmmu.data_size << endl;
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1197
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1198	dataOffset = fmmu.logical_address - domain.logical_base_address;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1199	if (dataOffset + fmmu.data_size > domain.data_size) {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1200	stringstream err;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1201	err << "Fmmu information corrupted!";
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1202	delete [] processData;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1203	throw MasterException(err.str());
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1204	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1205
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1206	cout << " " << hex << setfill('0');
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1207	for (j = 0; j < fmmu.data_size; j++) {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1208	cout << setw(2)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1209	<< (unsigned int) *(processData + dataOffset + j) << " ";
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1210	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1211	cout << endl;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1212	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1213
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1214	delete [] processData;
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1215	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1216
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1217	/****************************************************************************/
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1218
966 f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1219	void Master::listSlavePdos(
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1220	uint16_t slavePosition,
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1221	bool quiet,
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1222	bool withHeader
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1223	)
936 30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	1224	{
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1225	ec_ioctl_slave_t slave;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1226	ec_ioctl_sync_t sync;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1227	ec_ioctl_pdo_t pdo;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1228	ec_ioctl_pdo_entry_t entry;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1229	unsigned int i, j, k;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1230
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1231	getSlave(&slave, slavePosition);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1232
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1233	if (withHeader)
936 30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	1234	cout << "=== Slave " << slavePosition << " ===" << endl;
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	1235
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1236	for (i = 0; i < slave.sync_count; i++) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1237	getSync(&sync, slavePosition, i);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1238
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1239	cout << "SM" << i << ":"
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1240	<< " PhysAddr 0x"
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1241	<< hex << setfill('0') << setw(4) << sync.physical_start_address
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1242	<< ", DefaultSize "
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1243	<< dec << setfill(' ') << setw(4) << sync.default_size
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1244	<< ", ControlRegister 0x"
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1245	<< hex << setfill('0') << setw(2)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1246	<< (unsigned int) sync.control_register
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1247	<< ", Enable " << dec << (unsigned int) sync.enable
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1248	<< endl;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1249
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1250	for (j = 0; j < sync.pdo_count; j++) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1251	getPdo(&pdo, slavePosition, i, j);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1252
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1253	cout << " " << (pdo.dir ? "T" : "R") << "xPdo 0x"
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1254	<< hex << setfill('0') << setw(4) << pdo.index
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1255	<< " \"" << pdo.name << "\"" << endl;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1256
966 f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1257	if (quiet)
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1258	continue;
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1259
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1260	for (k = 0; k < pdo.entry_count; k++) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1261	getPdoEntry(&entry, slavePosition, i, j, k);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1262
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1263	cout << " Pdo entry 0x"
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1264	<< hex << setfill('0') << setw(4) << entry.index
990 4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1265	<< ":" << setw(2) << (unsigned int) entry.subindex
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1266	<< ", " << dec << (unsigned int) entry.bit_length
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1267	<< " bit, \"" << entry.name << "\"" << endl;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1268	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1269	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1270	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1271	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1272
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1273	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1274
966 f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1275	void Master::listSlaveSdos(
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1276	uint16_t slavePosition,
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1277	bool quiet,
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1278	bool withHeader
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1279	)
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1280	{
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1281	ec_ioctl_slave_t slave;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1282	ec_ioctl_sdo_t sdo;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1283	ec_ioctl_sdo_entry_t entry;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1284	unsigned int i, j, k;
970 b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1285	const CoEDataType *d;
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1286
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1287	getSlave(&slave, slavePosition);
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1288
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1289	if (withHeader)
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1290	cout << "=== Slave " << slavePosition << " ===" << endl;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1291
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1292	for (i = 0; i < slave.sdo_count; i++) {
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1293	getSdo(&sdo, slavePosition, i);
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1294
970 b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1295	cout << "Sdo "
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1296	<< hex << setfill('0') << setw(4) << sdo.sdo_index
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1297	<< ", \"" << sdo.name << "\"" << endl;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1298
966 f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1299	if (quiet)
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1300	continue;
f1a7ea8a550a Added -q flag (quiet). Florian Pose <fp@igh-essen.com> parents: 965 diff changeset	1301
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1302	for (j = 0; j <= sdo.max_subindex; j++) {
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1303	getSdoEntry(&entry, slavePosition, -i, j);
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1304
983 efb947bd96f3 Output Sdo index at entry. Florian Pose <fp@igh-essen.com> parents: 982 diff changeset	1305	cout << " " << hex << setfill('0')
efb947bd96f3 Output Sdo index at entry. Florian Pose <fp@igh-essen.com> parents: 982 diff changeset	1306	<< setw(4) << sdo.sdo_index << ":"
efb947bd96f3 Output Sdo index at entry. Florian Pose <fp@igh-essen.com> parents: 982 diff changeset	1307	<< setw(2) << (unsigned int) entry.sdo_entry_subindex
970 b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1308	<< ", ";
b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1309
b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1310	if ((d = findDataType(entry.data_type))) {
b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1311	cout << d->name;
b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1312	} else {
b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1313	cout << "type " << setw(4) << entry.data_type;
b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1314	}
b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1315
b7cbff36bc01 Display textual data type in 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 968 diff changeset	1316	cout << ", " << dec << entry.bit_length << " bit, \""
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1317	<< entry.description << "\"" << endl;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1318	}
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1319	}
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1320	}
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1321
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1322	/****************************************************************************/
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1323
989 816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1324	void Master::showSlave(uint16_t slavePosition)
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1325	{
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1326	ec_ioctl_slave_t slave;
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1327	list<string> protoList;
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1328	list<string>::const_iterator protoIter;
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1329
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1330	getSlave(&slave, slavePosition);
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1331
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1332	cout << "Slave " << dec << slavePosition << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1333	<< "Alias: 0x" << hex << setfill('0') << setw(4) << slave.alias << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1334	<< "State: " << slaveState(slave.state) << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1335	<< "Flag: " << (slave.error_flag ? 'E' : '+') << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1336	<< "Identity:" << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1337	<< " Vendor Id: 0x"
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1338	<< hex << setfill('0') << setw(8) << slave.vendor_id << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1339	<< " Product code: 0x"
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1340	<< setw(8) << slave.product_code << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1341	<< " Revision number: 0x"
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1342	<< setw(8) << slave.revision_number << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1343	<< " Serial number: 0x"
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1344	<< setw(8) << slave.serial_number << endl;
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1345
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1346	if (slave.mailbox_protocols) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1347	cout << "Mailboxes:" << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1348	<< " RX: 0x"
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1349	<< hex << setw(4) << slave.rx_mailbox_offset << "/"
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1350	<< dec << slave.rx_mailbox_size
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1351	<< ", TX: 0x"
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1352	<< hex << setw(4) << slave.tx_mailbox_offset << "/"
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1353	<< dec << slave.tx_mailbox_size << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1354	<< " Supported protocols: ";
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1355
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1356	if (slave.mailbox_protocols & EC_MBOX_AOE) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1357	protoList.push_back("AoE");
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1358	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1359	if (slave.mailbox_protocols & EC_MBOX_EOE) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1360	protoList.push_back("EoE");
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1361	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1362	if (slave.mailbox_protocols & EC_MBOX_COE) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1363	protoList.push_back("CoE");
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1364	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1365	if (slave.mailbox_protocols & EC_MBOX_FOE) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1366	protoList.push_back("FoE");
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1367	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1368	if (slave.mailbox_protocols & EC_MBOX_SOE) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1369	protoList.push_back("SoE");
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1370	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1371	if (slave.mailbox_protocols & EC_MBOX_VOE) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1372	protoList.push_back("VoE");
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1373	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1374
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1375	for (protoIter = protoList.begin(); protoIter != protoList.end();
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1376	protoIter++) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1377	if (protoIter != protoList.begin())
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1378	cout << ", ";
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1379	cout << *protoIter;
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1380	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1381	cout << endl;
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1382	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1383
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1384	if (slave.has_general_category) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1385	cout << "General:" << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1386	<< " Name: " << slave.name << endl;
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1387
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1388	if (slave.mailbox_protocols & EC_MBOX_COE) {
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1389	cout << " CoE details:" << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1390	<< " Enable Sdo: "
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1391	<< (slave.coe_details.enable_sdo ? "yes" : "no") << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1392	<< " Enable Sdo Info: "
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1393	<< (slave.coe_details.enable_sdo_info ? "yes" : "no") << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1394	<< " Enable Pdo Assign: "
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1395	<< (slave.coe_details.enable_pdo_assign
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1396	? "yes" : "no") << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1397	<< " Enable Pdo Configuration: "
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1398	<< (slave.coe_details.enable_pdo_configuration
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1399	? "yes" : "no") << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1400	<< " Enable Upload at startup: "
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1401	<< (slave.coe_details.enable_upload_at_startup
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1402	? "yes" : "no") << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1403	<< " Enable Sdo complete access: "
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1404	<< (slave.coe_details.enable_sdo_complete_access
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1405	? "yes" : "no") << endl;
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1406	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1407
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1408	cout << " Flags:" << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1409	<< " Enable SafeOp: "
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1410	<< (slave.general_flags.enable_safeop ? "yes" : "no") << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1411	<< " Enable notLRW: "
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1412	<< (slave.general_flags.enable_not_lrw ? "yes" : "no") << endl
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1413	<< " Current consumption: "
990 4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1414	<< dec << slave.current_on_ebus << " mA" << endl;
989 816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1415	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1416	cout << endl;
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1417	}
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1418
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1419	/****************************************************************************/
816663ca9370 Slave information via 'ethercat slave'. Florian Pose <fp@igh-essen.com> parents: 988 diff changeset	1420
938 5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1421	void Master::generateSlaveXml(uint16_t slavePosition)
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1422	{
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1423	ec_ioctl_slave_t slave;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1424	ec_ioctl_sync_t sync;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1425	ec_ioctl_pdo_t pdo;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1426	ec_ioctl_pdo_entry_t entry;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1427	unsigned int i, j, k;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1428
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1429	getSlave(&slave, slavePosition);
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1430
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1431	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1432	<< "<?xml version=\"1.0\" ?>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1433	<< " <EtherCATInfo>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1434	<< " <!-- Slave " << slave.position << " -->" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1435	<< " <Vendor>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1436	<< " <Id>" << slave.vendor_id << "</Id>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1437	<< " </Vendor>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1438	<< " <Descriptions>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1439	<< " <Devices>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1440	<< " <Device>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1441	<< " <Type ProductCode=\"#x"
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1442	<< hex << setfill('0') << setw(8) << slave.product_code
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1443	<< "\" RevisionNo=\"#x"
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1444	<< hex << setfill('0') << setw(8) << slave.revision_number
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1445	<< "\"/>" << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1446
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1447	for (i = 0; i < slave.sync_count; i++) {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1448	getSync(&sync, slavePosition, i);
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1449
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1450	for (j = 0; j < sync.pdo_count; j++) {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1451	getPdo(&pdo, slavePosition, i, j);
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1452
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1453	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1454	<< " <" << (pdo.dir ? "T" : "R") << "xPdo>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1455	<< " <Index>#x"
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1456	<< hex << setfill('0') << setw(4) << pdo.index
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1457	<< "</Index>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1458	<< " <Name>" << pdo.name << "</Name>" << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1459
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1460	for (k = 0; k < pdo.entry_count; k++) {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1461	getPdoEntry(&entry, slavePosition, i, j, k);
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1462
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1463	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1464	<< " <Entry>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1465	<< " <Index>#x"
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1466	<< hex << setfill('0') << setw(4) << entry.index
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1467	<< "</Index>" << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1468	if (entry.index)
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1469	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1470	<< " <SubIndex>"
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1471	<< dec << (unsigned int) entry.subindex
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1472	<< "</SubIndex>" << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1473
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1474	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1475	<< " <BitLen>"
1030 d7970e934dba Bugfix: Bitlength always decimal in XML. Florian Pose <fp@igh-essen.com> parents: 1029 diff changeset	1476	<< dec << (unsigned int) entry.bit_length
938 5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1477	<< "</BitLen>" << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1478
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1479	if (entry.index) {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1480	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1481	<< " <Name>" << entry.name
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1482	<< "</Name>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1483	<< " <DataType>";
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1484
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1485	if (entry.bit_length == 1) {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1486	cout << "BOOL";
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1487	} else if (!(entry.bit_length % 8)) {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1488	if (entry.bit_length <= 64)
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1489	cout << "UINT" << (unsigned int) entry.bit_length;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1490	else
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1491	cout << "STRING("
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1492	<< (unsigned int) (entry.bit_length / 8)
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1493	<< ")";
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1494	} else {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1495	cerr << "Invalid bit length "
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1496	<< (unsigned int) entry.bit_length << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1497	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1498
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1499	cout << "</DataType>" << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1500	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1501
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1502	cout << " </Entry>" << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1503	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1504
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1505	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1506	<< " </" << (pdo.dir ? "T" : "R") << "xPdo>" << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1507	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1508	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1509
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1510	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1511	<< " </Device>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1512	<< " </Devices>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1513	<< " </Descriptions>" << endl
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1514	<< "</EtherCATInfo>" << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1515	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1516
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1517	/****************************************************************************/
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	1518
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1519	unsigned int Master::slaveCount()
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1520	{
957 ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1521	ec_ioctl_master_t data;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1522
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1523	getMaster(&data);
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1524	return data.slave_count;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1525	}
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1526
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1527	/****************************************************************************/
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1528
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1529	void Master::getMaster(ec_ioctl_master_t *data)
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1530	{
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1531	if (ioctl(fd, EC_IOCTL_MASTER, data) < 0) {
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1532	stringstream err;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1533	err << "Failed to get master information: " << strerror(errno);
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1534	throw MasterException(err.str());
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	1535	}
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1536	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1537
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1538	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1539
990 4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1540	void Master::getConfig(ec_ioctl_config_t *data, unsigned int index)
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1541	{
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1542	data->config_index = index;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1543
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1544	if (ioctl(fd, EC_IOCTL_CONFIG, data) < 0) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1545	stringstream err;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1546	err << "Failed to get slave configuration: " << strerror(errno);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1547	throw MasterException(err.str());
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1548	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1549	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1550
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1551	/****************************************************************************/
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1552
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1553	void Master::getConfigPdo(
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1554	ec_ioctl_config_pdo_t *data,
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1555	unsigned int index,
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1556	unsigned int dir,
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1557	unsigned int pdo_pos
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1558	)
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1559	{
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1560	data->config_index = index;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1561	data->direction = dir;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1562	data->pdo_pos = pdo_pos;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1563
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1564	if (ioctl(fd, EC_IOCTL_CONFIG_PDO, data) < 0) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1565	stringstream err;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1566	err << "Failed to get slave config Pdo: " << strerror(errno);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1567	throw MasterException(err.str());
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1568	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1569	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1570
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1571	/****************************************************************************/
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1572
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1573	void Master::getConfigPdoEntry(
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1574	ec_ioctl_config_pdo_entry_t *data,
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1575	unsigned int index,
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1576	unsigned int dir,
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1577	unsigned int pdo_pos,
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1578	unsigned int entry_pos
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1579	)
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1580	{
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1581	data->config_index = index;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1582	data->direction = dir;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1583	data->pdo_pos = pdo_pos;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1584	data->entry_pos = entry_pos;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1585
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1586	if (ioctl(fd, EC_IOCTL_CONFIG_PDO_ENTRY, data) < 0) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1587	stringstream err;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1588	err << "Failed to get slave config Pdo entry: " << strerror(errno);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1589	throw MasterException(err.str());
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1590	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1591	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1592
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1593	/****************************************************************************/
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1594
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1595	void Master::getConfigSdo(
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1596	ec_ioctl_config_sdo_t *data,
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1597	unsigned int index,
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1598	unsigned int sdo_pos
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1599	)
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1600	{
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1601	data->config_index = index;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1602	data->sdo_pos = sdo_pos;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1603
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1604	if (ioctl(fd, EC_IOCTL_CONFIG_SDO, data) < 0) {
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1605	stringstream err;
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1606	err << "Failed to get slave config Sdo: " << strerror(errno);
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1607	throw MasterException(err.str());
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1608	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1609	}
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1610
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1611	/****************************************************************************/
4f223f3df05a Bus configuration via 'ethercat config'. Florian Pose <fp@igh-essen.com> parents: 989 diff changeset	1612
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1613	void Master::getDomain(ec_ioctl_domain_t *data, unsigned int index)
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1614	{
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1615	data->index = index;
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1616
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1617	if (ioctl(fd, EC_IOCTL_DOMAIN, data)) {
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1618	stringstream err;
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1619	err << "Failed to get domain: ";
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1620	if (errno == EINVAL)
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1621	err << "Domain " << index << " does not exist!";
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1622	else
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1623	err << strerror(errno);
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1624	throw MasterException(err.str());
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1625	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1626	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1627
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1628	/****************************************************************************/
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	1629
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1630	void Master::getData(ec_ioctl_data_t *data, unsigned int domainIndex,
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1631	unsigned int dataSize, unsigned char *mem)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1632	{
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1633	data->domain_index = domainIndex;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1634	data->data_size = dataSize;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1635	data->target = mem;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1636
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1637	if (ioctl(fd, EC_IOCTL_DATA, data) < 0) {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1638	stringstream err;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1639	err << "Failed to get domain data: " << strerror(errno);
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1640	throw MasterException(err.str());
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1641	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1642	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1643
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1644	/****************************************************************************/
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1645
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1646	void Master::getSlave(ec_ioctl_slave_t *slave, uint16_t slaveIndex)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1647	{
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1648	slave->position = slaveIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1649
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1650	if (ioctl(fd, EC_IOCTL_SLAVE, slave)) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1651	stringstream err;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1652	err << "Failed to get slave: ";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1653	if (errno == EINVAL)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1654	err << "Slave " << slaveIndex << " does not exist!";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1655	else
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1656	err << strerror(errno);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1657	throw MasterException(err.str());
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1658	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1659	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1660
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1661	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1662
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1663	void Master::getFmmu(
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1664	ec_ioctl_domain_fmmu_t *fmmu,
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1665	unsigned int domainIndex,
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1666	unsigned int fmmuIndex
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1667	)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1668	{
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1669	fmmu->domain_index = domainIndex;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1670	fmmu->fmmu_index = fmmuIndex;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1671
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1672	if (ioctl(fd, EC_IOCTL_DOMAIN_FMMU, fmmu)) {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1673	stringstream err;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1674	err << "Failed to get domain FMMU: ";
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1675	if (errno == EINVAL)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1676	err << "Either domain " << domainIndex << " does not exist, "
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1677	<< "or it contains less than " << (unsigned int) fmmuIndex + 1
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1678	<< " FMMus!";
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1679	else
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1680	err << strerror(errno);
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1681	throw MasterException(err.str());
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1682	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1683	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1684
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1685	/****************************************************************************/
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1686
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1687	void Master::getSync(
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1688	ec_ioctl_sync_t *sync,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1689	uint16_t slaveIndex,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1690	uint8_t syncIndex
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1691	)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1692	{
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1693	sync->slave_position = slaveIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1694	sync->sync_index = syncIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1695
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1696	if (ioctl(fd, EC_IOCTL_SYNC, sync)) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1697	stringstream err;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1698	err << "Failed to get sync manager: ";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1699	if (errno == EINVAL)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1700	err << "Either slave " << slaveIndex << " does not exist, "
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1701	<< "or it contains less than " << (unsigned int) syncIndex + 1
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1702	<< " sync managers!";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1703	else
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1704	err << strerror(errno);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1705	throw MasterException(err.str());
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1706	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1707	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1708
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1709	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1710
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1711	void Master::getPdo(
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1712	ec_ioctl_pdo_t *pdo,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1713	uint16_t slaveIndex,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1714	uint8_t syncIndex,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1715	uint8_t pdoPos
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1716	)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1717	{
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1718	pdo->slave_position = slaveIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1719	pdo->sync_index = syncIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1720	pdo->pdo_pos = pdoPos;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1721
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1722	if (ioctl(fd, EC_IOCTL_PDO, pdo)) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1723	stringstream err;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1724	err << "Failed to get Pdo: ";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1725	if (errno == EINVAL)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1726	err << "Either slave " << slaveIndex << " does not exist, "
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1727	<< "or it contains less than " << (unsigned int) syncIndex + 1
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1728	<< " sync managers, or sync manager "
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1729	<< (unsigned int) syncIndex << " contains less than "
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1730	<< pdoPos + 1 << " Pdos!" << endl;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1731	else
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1732	err << strerror(errno);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1733	throw MasterException(err.str());
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1734	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1735	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1736
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1737	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1738
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1739	void Master::getPdoEntry(
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1740	ec_ioctl_pdo_entry_t *entry,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1741	uint16_t slaveIndex,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1742	uint8_t syncIndex,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1743	uint8_t pdoPos,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1744	uint8_t entryPos
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1745	)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1746	{
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1747	entry->slave_position = slaveIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1748	entry->sync_index = syncIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1749	entry->pdo_pos = pdoPos;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1750	entry->entry_pos = entryPos;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1751
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1752	if (ioctl(fd, EC_IOCTL_PDO_ENTRY, entry)) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1753	stringstream err;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1754	err << "Failed to get Pdo entry: ";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1755	if (errno == EINVAL)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1756	err << "Either slave " << slaveIndex << " does not exist, "
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	1757	<< "or it contains less than " << (unsigned int) syncIndex + 1
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1758	<< " sync managers, or sync manager "
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1759	<< (unsigned int) syncIndex << " contains less than "
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1760	<< pdoPos + 1 << " Pdos, or the Pdo at position " << pdoPos
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1761	<< " contains less than " << (unsigned int) entryPos + 1
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1762	<< " entries!" << endl;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1763	else
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1764	err << strerror(errno);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1765	throw MasterException(err.str());
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1766	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1767	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1768
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1769	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1770
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1771	void Master::getSdo(
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1772	ec_ioctl_sdo_t *sdo,
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1773	uint16_t slaveIndex,
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1774	uint16_t sdoPosition
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1775	)
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1776	{
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1777	sdo->slave_position = slaveIndex;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1778	sdo->sdo_position = sdoPosition;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1779
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1780	if (ioctl(fd, EC_IOCTL_SDO, sdo)) {
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1781	stringstream err;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1782	err << "Failed to get Sdo: ";
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1783	if (errno == EINVAL)
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1784	err << "Either slave " << slaveIndex << " does not exist, "
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1785	<< "or it contains less than " << sdoPosition + 1 << " Sdos!"
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1786	<< endl;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1787	else
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1788	err << strerror(errno);
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1789	throw MasterException(err.str());
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1790	}
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1791	}
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1792
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1793	/****************************************************************************/
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1794
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1795	void Master::getSdoEntry(
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1796	ec_ioctl_sdo_entry_t *entry,
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1797	uint16_t slaveIndex,
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1798	int sdoSpec,
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1799	uint8_t entrySubindex
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1800	)
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1801	{
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1802	entry->slave_position = slaveIndex;
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1803	entry->sdo_spec = sdoSpec;
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1804	entry->sdo_entry_subindex = entrySubindex;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1805
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1806	if (ioctl(fd, EC_IOCTL_SDO_ENTRY, entry)) {
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1807	stringstream err;
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1808	err << "Failed to get Sdo entry: ";
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1809	err << strerror(errno);
965 1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1810	throw MasterException(err.str());
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1811	}
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1812	}
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1813
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1814	/****************************************************************************/
1aee4aa1def3 Implemented Sdo dictionary info via 'ethercat sdos'. Florian Pose <fp@igh-essen.com> parents: 960 diff changeset	1815
960 36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1816	void Master::requestState(
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1817	uint16_t slavePosition,
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1818	uint8_t state
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1819	)
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1820	{
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1821	ec_ioctl_slave_state_t data;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1822
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1823	data.slave_position = slavePosition;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1824	data.requested_state = state;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1825
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1826	if (ioctl(fd, EC_IOCTL_SLAVE_STATE, &data)) {
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1827	stringstream err;
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1828	err << "Failed to request slave state: ";
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1829	if (errno == EINVAL)
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1830	err << "Slave " << slavePosition << " does not exist!";
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1831	else
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1832	err << strerror(errno);
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1833	throw MasterException(err.str());
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1834	}
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1835	}
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1836
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1837	/****************************************************************************/
36e460ffbb5e Request slave state(s) with 'ethercat state'; removed sysfs state file. Florian Pose <fp@igh-essen.com> parents: 957 diff changeset	1838
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	1839	string Master::slaveState(uint8_t state)
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1840	{
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1841	switch (state) {
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1842	case 1: return "INIT";
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1843	case 2: return "PREOP";
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1844	case 4: return "SAFEOP";
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1845	case 8: return "OP";
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1846	default: return "???";
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1847	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1848	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1849
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	1850	/****************************************************************************/
968 b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1851
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1852	void Master::printRawData(
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1853	const uint8_t *data,
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1854	unsigned int size)
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1855	{
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1856	cout << hex << setfill('0');
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1857	while (size--) {
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1858	cout << "0x" << setw(2) << (unsigned int) *data++;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1859	if (size)
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1860	cout << " ";
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1861	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1862	cout << endl;
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1863	}
b0e894257743 Implemented sdo_upload command. Florian Pose <fp@igh-essen.com> parents: 966 diff changeset	1864
980 c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1865	/*****************************************************************************/
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1866
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1867	/**
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1868	* Calculates the SII checksum field.
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1869	*
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1870	* The checksum is generated with the polynom x^8+x^2+x+1 (0x07) and an
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1871	* initial value of 0xff (see IEC 61158-6-12 ch. 5.4).
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1872	*
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1873	* The below code was originally generated with PYCRC
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1874	* http://www.tty1.net/pycrc
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1875	*
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1876	* ./pycrc.py --width=8 --poly=0x07 --reflect-in=0 --xor-in=0xff
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1877	* --reflect-out=0 --xor-out=0 --generate c --algorithm=bit-by-bit
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1878	*
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1879	* \return CRC8
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1880	*/
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1881	uint8_t Master::calcSiiCrc(
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1882	const uint8_t data, /< pointer to data /
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1883	size_t length /*< number of bytes in \a data /
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1884	)
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1885	{
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1886	unsigned int i;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1887	uint8_t bit, byte, crc = 0x48;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1888
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1889	while (length--) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1890	byte = *data++;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1891	for (i = 0; i < 8; i++) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1892	bit = crc & 0x80;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1893	crc = (crc << 1) \| ((byte >> (7 - i)) & 0x01);
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1894	if (bit) crc ^= 0x07;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1895	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1896	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1897
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1898	for (i = 0; i < 8; i++) {
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1899	bit = crc & 0x80;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1900	crc <<= 1;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1901	if (bit) crc ^= 0x07;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1902	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1903
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1904	return crc;
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1905	}
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1906
c07dd38243ba Implemented SII writing (including alias writing) via ethercat command. Florian Pose <fp@igh-essen.com> parents: 978 diff changeset	1907	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Mon, 23 Jun 2008 09:52:23 +0000
changeset 1049	91a0d7226e0b
parent 1037	59f191c9185b
child 1055	2be8918682fa
permissions	-rw-r--r--