etherlabmaster: tools/Master.cpp@ed5ac2e83495 (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>
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	16	using namespace std;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	17
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	18	#include "Master.h"
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	19
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
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	22	Master::Master()
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	23	{
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	24	index = 0;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	25	fd = -1;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	26	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	27
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	28	/****************************************************************************/
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	29
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	30	Master::~Master()
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	31	{
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	32	close();
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	33	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	34
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	35	/****************************************************************************/
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	36
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	37	void Master::open(unsigned int index)
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	38	{
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	39	stringstream deviceName;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	40
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	41	Master::index = index;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	42
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	43	deviceName << "/dev/EtherCAT" << index;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	44
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	45	if ((fd = ::open(deviceName.str().c_str(), O_RDONLY)) == -1) {
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	46	stringstream err;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	47	err << "Failed to open master device " << deviceName.str() << ": "
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	48	<< strerror(errno);
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	49	throw MasterException(err.str());
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	50	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	51	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	52
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	53	/****************************************************************************/
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	54
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	55	void Master::close()
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	56	{
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	57	if (fd == -1)
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	58	return;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	59
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	60	::close(fd);
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	61	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	62
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	63	/****************************************************************************/
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	64
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	65	void Master::outputData(int domainIndex)
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	66	{
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	67	if (domainIndex == -1) {
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	68	unsigned int numDomains = domainCount(), i;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	69
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	70	for (i = 0; i < numDomains; i++) {
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	71	outputDomainData(i);
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	72	}
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	73	} else {
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	74	outputDomainData(domainIndex);
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	75	}
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	76	}
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	77
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	78	/****************************************************************************/
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	79
956 d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	80	void Master::setDebug(const vector<string> &commandArgs)
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	81	{
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	82	stringstream str;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	83	int debugLevel;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	84
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	85	if (commandArgs.size() != 1) {
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	86	stringstream err;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	87	err << "'debug' takes exactly one argument!";
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	88	throw MasterException(err.str());
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	89	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	90
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	91	str << commandArgs[0];
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	92	str >> debugLevel;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	93
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	94	if (str.fail()) {
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	95	stringstream err;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	96	err << "Invalid debug level '" << commandArgs[0] << "'!";
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	97	throw MasterException(err.str());
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	98	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	99
957 ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	100	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	101	stringstream err;
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	102	err << "Failed to set debug level: " << strerror(errno);
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	103	throw MasterException(err.str());
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	104	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	105	}
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	106
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	107	/****************************************************************************/
d9b9bc794d10 Implemented 'ethercat debug' command. Florian Pose <fp@igh-essen.com> parents: 951 diff changeset	108
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	109	void Master::showDomains(int domainIndex)
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	110	{
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	111	if (domainIndex == -1) {
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	112	unsigned int numDomains = domainCount(), i;
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	113
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	114	for (i = 0; i < numDomains; i++) {
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	115	showDomain(i);
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	116	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	117	} else {
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	118	showDomain(domainIndex);
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	119	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	120	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	121
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	122	/****************************************************************************/
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	123
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	124	void Master::listSlaves()
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	125	{
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	126	unsigned int numSlaves = slaveCount(), i;
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	127	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	128	uint16_t lastAlias, aliasIndex;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	129
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	130	lastAlias = 0;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	131	aliasIndex = 0;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	132	for (i = 0; i < numSlaves; i++) {
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	133	getSlave(&slave, i);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	134	cout << setw(2) << i << " ";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	135
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	136	if (slave.alias) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	137	lastAlias = slave.alias;
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	138	aliasIndex = 0;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	139	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	140	if (lastAlias) {
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	141	cout << setw(10) << "#" << lastAlias << ":" << aliasIndex;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	142	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	143
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	144	cout << " " << slaveState(slave.state) << " ";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	145
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	146	if (strlen(slave.name)) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	147	cout << slave.name;
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	148	} else {
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	149	cout << "0x" << hex << setfill('0') << slave.vendor_id
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	150	<< ":0x" << slave.product_code;
922 fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	151	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	152
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	153	cout << endl;
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	154	}
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	155	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	156
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	157	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	158
957 ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	159	void Master::showMaster()
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	160	{
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	161	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	162	stringstream err;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	163	unsigned int i;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	164
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	165	getMaster(&data);
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	166
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	167	cout
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	168	<< "Master" << index << endl
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	169	<< " State: ";
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	170
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	171	switch (data.mode) {
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	172	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	173	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	174	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	175	default:
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	176	err << "Invalid master state " << data.mode;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	177	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	178	}
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	179
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	180	cout << endl
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	181	<< " 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	182
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	183	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	184	cout << " Device" << i << ": ";
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	185	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	186	&& 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	187	&& 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	188	&& 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	189	&& 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	190	&& 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	191	cout << "None.";
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	192	} else {
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	193	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	194	<< 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	195	<< 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	196	<< 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	197	<< 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	198	<< 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	199	<< 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	200	<< (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	201	<< ")" << endl << dec
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	202	<< " 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	203	<< " 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	204	}
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	205	cout << endl;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	206	}
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	207	}
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	208
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	209	/****************************************************************************/
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	210
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	211	void Master::listPdos(int slavePosition)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	212	{
936 30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	213	if (slavePosition == -1) {
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	214	unsigned int numSlaves = slaveCount(), i;
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	215
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	216	for (i = 0; i < numSlaves; i++) {
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	217	listSlavePdos(i, true);
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	218	}
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	219	} else {
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	220	listSlavePdos(slavePosition, false);
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	221	}
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	222	}
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	223
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	224	/****************************************************************************/
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	225
938 5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	226	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	227	{
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	228	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	229	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	230
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	231	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	232	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	233	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	234	} else {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	235	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	236	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	237	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	238
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	239	/****************************************************************************/
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	240
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	241	void Master::outputDomainData(unsigned int domainIndex)
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	242	{
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	243	ec_ioctl_domain_t domain;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	244	ec_ioctl_data_t data;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	245	unsigned char *processData;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	246	unsigned int i;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	247
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	248	getDomain(&domain, domainIndex);
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	249
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	250	if (!domain.data_size)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	251	return;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	252
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	253	processData = new unsigned char[domain.data_size];
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	254
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	255	try {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	256	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	257	} catch (MasterException &e) {
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	258	delete [] processData;
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	259	throw e;
949 e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	260	}
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	261
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	262	for (i = 0; i < data.data_size; i++)
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	263	cout << processData[i];
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	264	cout.flush();
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	265
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	266	delete [] processData;
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	267	}
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	268
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	269	/****************************************************************************/
e424c0074c67 Implemented 'data' command. Florian Pose <fp@igh-essen.com> parents: 948 diff changeset	270
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	271	void Master::showDomain(unsigned int domainIndex)
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	272	{
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	273	ec_ioctl_domain_t domain;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	274	unsigned char *processData;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	275	ec_ioctl_data_t data;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	276	unsigned int i, j;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	277	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	278	unsigned int dataOffset;
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	279
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	280	getDomain(&domain, domainIndex);
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	281
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	282	cout << "Domain" << domainIndex << ":"
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	283	<< " LogBaseAddr 0x"
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	284	<< 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	285	<< ", Size " << dec << setfill(' ') << setw(3) << domain.data_size
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	286	<< ", WorkingCounter "
951 dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	287	<< dec << domain.working_counter << "/"
dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	288	<< 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	289
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	290	if (!domain.data_size)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	291	return;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	292
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	293	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	294
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	295	try {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	296	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	297	} catch (MasterException &e) {
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	298	delete [] processData;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	299	throw e;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	300	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	301
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	302	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	303	getFmmu(&fmmu, domainIndex, i);
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	304
951 dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	305	cout << " SlaveConfig "
dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	306	<< fmmu.slave_config_alias << ":" << fmmu.slave_config_position
dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	307	<< ", Dir "
dc84a0af63da Improved output of 'ethercat domain'. Florian Pose <fp@igh-essen.com> parents: 950 diff changeset	308	<< 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	309	<< ", LogAddr 0x"
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	310	<< 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	311	<< ", 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	312
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	313	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	314	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	315	stringstream err;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	316	err << "Fmmu information corrupted!";
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	317	delete [] processData;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	318	throw MasterException(err.str());
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	319	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	320
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	321	cout << " " << hex << setfill('0');
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	322	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	323	cout << setw(2)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	324	<< (unsigned int) *(processData + dataOffset + j) << " ";
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	325	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	326	cout << endl;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	327	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	328
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	329	delete [] processData;
948 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
936 30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	334	void Master::listSlavePdos(uint16_t slavePosition, bool printSlave)
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	335	{
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	336	ec_ioctl_slave_t slave;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	337	ec_ioctl_sync_t sync;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	338	ec_ioctl_pdo_t pdo;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	339	ec_ioctl_pdo_entry_t entry;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	340	unsigned int i, j, k;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	341
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	342	getSlave(&slave, slavePosition);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	343
936 30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	344	if (printSlave)
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	345	cout << "=== Slave " << slavePosition << " ===" << endl;
30fddfce8db6 Added multi-slave support. Florian Pose <fp@igh-essen.com> parents: 935 diff changeset	346
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	347	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	348	getSync(&sync, slavePosition, i);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	349
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	350	cout << "SM" << i << ":"
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	351	<< " PhysAddr 0x"
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	352	<< 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	353	<< ", DefaultSize "
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	354	<< dec << setfill(' ') << setw(4) << sync.default_size
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	355	<< ", ControlRegister 0x"
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	356	<< hex << setfill('0') << setw(2)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	357	<< (unsigned int) sync.control_register
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	358	<< ", Enable " << dec << (unsigned int) sync.enable
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	359	<< endl;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	360
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	361	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	362	getPdo(&pdo, slavePosition, i, j);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	363
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	364	cout << " " << (pdo.dir ? "T" : "R") << "xPdo 0x"
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	365	<< hex << setfill('0') << setw(4) << pdo.index
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	366	<< " \"" << pdo.name << "\"" << endl;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	367
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	368	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	369	getPdoEntry(&entry, slavePosition, i, j, k);
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	cout << " Pdo entry 0x"
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	372	<< hex << setfill('0') << setw(4) << entry.index
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	373	<< ":" << hex << setfill('0') << setw(2)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	374	<< (unsigned int) entry.subindex
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	375	<< ", " << dec << (unsigned int) entry.bit_length
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	376	<< " bit, \"" << entry.name << "\"" << endl;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	377	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	378	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	379	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	380	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	381
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	382	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	383
938 5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	384	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	385	{
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	386	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	387	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	388	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	389	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	390	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	391
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	392	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	393
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	394	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	395	<< "<?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	396	<< " <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	397	<< " <!-- 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	398	<< " <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	399	<< " <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	400	<< " </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	401	<< " <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	402	<< " <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	403	<< " <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	404	<< " <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	405	<< 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	406	<< "\" 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	407	<< 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	408	<< "\"/>" << endl;
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	409
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	410	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	411	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	412
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	413	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	414	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	415
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	416	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	417	<< " <" << (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	418	<< " <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	419	<< 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	420	<< "</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	421	<< " <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	422
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	423	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	424	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	425
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	426	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	427	<< " <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	428	<< " <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	429	<< 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	430	<< "</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	431	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	432	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	433	<< " <SubIndex>"
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	434	<< 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	435	<< "</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	436
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	437	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	438	<< " <BitLen>"
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	439	<< (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	440	<< "</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	441
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	442	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	443	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	444	<< " <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	445	<< "</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	446	<< " <DataType>";
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	447
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	448	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	449	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	450	} 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	451	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	452	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	453	else
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	454	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	455	<< (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	456	<< ")";
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	457	} else {
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	458	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	459	<< (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	460	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	461
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	462	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	463	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	464
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	465	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	466	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	467
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	468	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	469	<< " </" << (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	470	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	471	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	472
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	473	cout
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	474	<< " </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	475	<< " </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	476	<< " </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	477	<< "</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	478	}
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	479
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	480	/****************************************************************************/
5b936e8e39fa Added 'xml' command to generate a slave description file from a real Florian Pose <fp@igh-essen.com> parents: 936 diff changeset	481
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	482	unsigned int Master::domainCount()
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	483	{
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	484	int ret;
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	485
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	486	if ((ret = ioctl(fd, EC_IOCTL_DOMAIN_COUNT, 0)) < 0) {
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	487	stringstream err;
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	488	err << "Failed to get number of domains: " << strerror(errno);
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	489	throw MasterException(err.str());
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	490	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	491
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	492	return ret;
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	493	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	494
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	495	/****************************************************************************/
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	496
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	497	unsigned int Master::slaveCount()
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	498	{
957 ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	499	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	500
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	501	getMaster(&data);
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	502	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	503	}
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	504
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	505	/****************************************************************************/
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	506
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	507	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	508	{
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	509	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	510	stringstream err;
ed5ac2e83495 Replaced EC_IOCTL_SLAVE_COUNT with EC_IOCTL_MASTER; implemented Florian Pose <fp@igh-essen.com> parents: 956 diff changeset	511	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	512	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	513	}
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	514	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	515
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	516	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	517
948 1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	518	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	519	{
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	520	data->index = index;
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	521
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	522	if (ioctl(fd, EC_IOCTL_DOMAIN, data)) {
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	523	stringstream err;
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	524	err << "Failed to get domain: ";
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	525	if (errno == EINVAL)
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	526	err << "Domain " << index << " does not exist!";
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	527	else
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	528	err << strerror(errno);
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	529	throw MasterException(err.str());
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	530	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	531	}
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	532
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	533	/****************************************************************************/
1cfab7161491 Implemented domain command. Florian Pose <fp@igh-essen.com> parents: 938 diff changeset	534
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	535	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	536	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	537	{
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	538	data->domain_index = domainIndex;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	539	data->data_size = dataSize;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	540	data->target = mem;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	541
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	542	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	543	stringstream err;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	544	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	545	throw MasterException(err.str());
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	546	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	547	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	548
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	549	/****************************************************************************/
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	550
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	551	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	552	{
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	553	slave->position = slaveIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	554
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	555	if (ioctl(fd, EC_IOCTL_SLAVE, slave)) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	556	stringstream err;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	557	err << "Failed to get slave: ";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	558	if (errno == EINVAL)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	559	err << "Slave " << slaveIndex << " does not exist!";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	560	else
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	561	err << strerror(errno);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	562	throw MasterException(err.str());
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	563	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	564	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	565
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	566	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	567
950 8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	568	void Master::getFmmu(
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	569	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	570	unsigned int domainIndex,
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	571	unsigned int fmmuIndex
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	572	)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	573	{
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	574	fmmu->domain_index = domainIndex;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	575	fmmu->fmmu_index = fmmuIndex;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	576
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	577	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	578	stringstream err;
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	579	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	580	if (errno == EINVAL)
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	581	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	582	<< "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	583	<< " FMMus!";
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	584	else
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	585	err << strerror(errno);
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	586	throw MasterException(err.str());
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	587	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	588	}
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	589
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	590	/****************************************************************************/
8b00e63fff90 'ethercat domain' shows domain contents and process data. Florian Pose <fp@igh-essen.com> parents: 949 diff changeset	591
935 b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	592	void Master::getSync(
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	593	ec_ioctl_sync_t *sync,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	594	uint16_t slaveIndex,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	595	uint8_t syncIndex
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	596	)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	597	{
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	598	sync->slave_position = slaveIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	599	sync->sync_index = syncIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	600
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	601	if (ioctl(fd, EC_IOCTL_SYNC, sync)) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	602	stringstream err;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	603	err << "Failed to get sync manager: ";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	604	if (errno == EINVAL)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	605	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	606	<< "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	607	<< " sync managers!";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	608	else
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	609	err << strerror(errno);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	610	throw MasterException(err.str());
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	611	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	612	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	613
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	614	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	615
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	616	void Master::getPdo(
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	617	ec_ioctl_pdo_t *pdo,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	618	uint16_t slaveIndex,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	619	uint8_t syncIndex,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	620	uint8_t pdoPos
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	621	)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	622	{
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	623	pdo->slave_position = slaveIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	624	pdo->sync_index = syncIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	625	pdo->pdo_pos = pdoPos;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	626
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	627	if (ioctl(fd, EC_IOCTL_PDO, pdo)) {
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	628	stringstream err;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	629	err << "Failed to get Pdo: ";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	630	if (errno == EINVAL)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	631	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	632	<< "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	633	<< " sync managers, or sync manager "
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	634	<< (unsigned int) syncIndex << " contains less than "
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	635	<< pdoPos + 1 << " Pdos!" << endl;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	636	else
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	637	err << strerror(errno);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	638	throw MasterException(err.str());
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	639	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	640	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	641
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	642	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	643
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	644	void Master::getPdoEntry(
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	645	ec_ioctl_pdo_entry_t *entry,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	646	uint16_t slaveIndex,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	647	uint8_t syncIndex,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	648	uint8_t pdoPos,
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	649	uint8_t entryPos
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	650	)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	651	{
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	652	entry->slave_position = slaveIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	653	entry->sync_index = syncIndex;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	654	entry->pdo_pos = pdoPos;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	655	entry->entry_pos = entryPos;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	656
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	657	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	658	stringstream err;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	659	err << "Failed to get Pdo entry: ";
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	660	if (errno == EINVAL)
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	661	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	662	<< "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	663	<< " sync managers, or sync manager "
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	664	<< (unsigned int) syncIndex << " contains less than "
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	665	<< 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	666	<< " contains less than " << (unsigned int) entryPos + 1
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	667	<< " entries!" << endl;
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	668	else
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	669	err << strerror(errno);
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	670	throw MasterException(err.str());
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	671	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	672	}
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	673
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	674	/****************************************************************************/
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	675
b954e9d91ea5 Added 'pdos' command to ethercat tool. Florian Pose <fp@igh-essen.com> parents: 922 diff changeset	676	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	677	{
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	678	switch (state) {
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	679	case 1: return "INIT";
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	680	case 2: return "PREOP";
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	681	case 4: return "SAFEOP";
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	682	case 8: return "OP";
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	683	default: return "???";
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	684	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	685	}
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	686
fede1d8f5b71 Added the new ethercat comman-line tool with lsec functionality. Florian Pose <fp@igh-essen.com> parents: diff changeset	687	/****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Thu, 05 Jun 2008 15:39:15 +0000
changeset 957	ed5ac2e83495
parent 956	d9b9bc794d10
child 960	36e460ffbb5e
permissions	-rw-r--r--