etherlabmaster: tool/DataTypeHandler.cpp@32136215c1fa (annotated)

1835 20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	1	/*****************************************************************************
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	3	* $Id$
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	5	* Copyright (C) 2006-2009 Florian Pose, Ingenieurgemeinschaft IgH
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	6	*
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	7	* This file is part of the IgH EtherCAT Master.
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	8	*
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	9	* The IgH EtherCAT Master is free software; you can redistribute it and/or
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	10	* modify it under the terms of the GNU General Public License version 2, as
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	11	* published by the Free Software Foundation.
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	12	*
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	13	* The IgH EtherCAT Master is distributed in the hope that it will be useful,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	16	* Public License for more details.
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	17	*
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	18	* You should have received a copy of the GNU General Public License along
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	19	* with the IgH EtherCAT Master; if not, write to the Free Software
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	20	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	21	*
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	22	* ---
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	23	*
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	24	* The license mentioned above concerns the source code only. Using the
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	25	* EtherCAT technology and brand is only permitted in compliance with the
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	26	* industrial property and similar rights of Beckhoff Automation GmbH.
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	27	*
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	28	****************************************************************************/
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	29
1837 32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	30	#define DEBUG 0
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	31
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	32	#if DEBUG
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	33	#include <iostream>
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	34	#endif
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	35
1835 20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	36	#include <iomanip>
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	37	#include <sstream>
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	38	using namespace std;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	39
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	40	#include "DataTypeHandler.h"
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	41
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	42	#include "ecrt.h"
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	43
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	44	/*****************************************************************************/
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	45
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	46	DataTypeHandler::DataTypeHandler()
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	47	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	48	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	49
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	50	/****************************************************************************/
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	51
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	52	const DataTypeHandler::DataType *DataTypeHandler::findDataType(
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	53	const string &str
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	54	)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	55	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	56	const DataType *d;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	57
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	58	for (d = dataTypes; d->name; d++)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	59	if (str == d->name)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	60	return d;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	61
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	62	return NULL; // FIXME exception
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	63	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	64
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	65	/****************************************************************************/
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	66
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	67	const DataTypeHandler::DataType *DataTypeHandler::findDataType(uint16_t code)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	68	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	69	const DataType *d;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	70
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	71	for (d = dataTypes; d->name; d++)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	72	if (code == d->code)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	73	return d;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	74
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	75	return NULL;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	76	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	77
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	78	/****************************************************************************/
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	79
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	80	size_t DataTypeHandler::interpretAsType(
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	81	const DataType *type,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	82	const string &source,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	83	void *target,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	84	size_t targetSize
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	85	)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	86	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	87	stringstream str;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	88	size_t dataSize = type->byteSize;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	89
1837 32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	90	#if DEBUG
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	91	cerr << __func__ << "(targetSize=" << targetSize << ")" << endl;
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	92	#endif
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	93
1835 20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	94	str << source;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	95	str >> resetiosflags(ios::basefield); // guess base from prefix
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	96	str.exceptions(ios::failbit);
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	97
1837 32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	98	#if DEBUG
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	99	cerr << "code=" << type->code << endl;
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	100	#endif
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	101
1835 20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	102	switch (type->code) {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	103	case 0x0002: // int8
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	104	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	105	int16_t val; // uint8_t is interpreted as char
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	106	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	107	if (val > 127 \|\| val < -128)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	108	throw ios::failure("Value out of range");
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	109	(uint8_t ) target = val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	110	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	111	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	112	case 0x0003: // int16
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	113	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	114	int16_t val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	115	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	116	(int16_t ) target = cpu_to_le16(val);
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	117	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	118	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	119	case 0x0004: // int32
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	120	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	121	int32_t val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	122	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	123	(int32_t ) target = cpu_to_le32(val);
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	124	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	125	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	126	case 0x0005: // uint8
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	127	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	128	uint16_t val; // uint8_t is interpreted as char
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	129	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	130	if (val > 0xff)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	131	throw ios::failure("Value out of range");
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	132	(uint8_t ) target = val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	133	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	134	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	135	case 0x0006: // uint16
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	136	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	137	uint16_t val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	138	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	139	(uint16_t ) target = cpu_to_le16(val);
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	140	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	141	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	142	case 0x0007: // uint32
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	143	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	144	uint32_t val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	145	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	146	(uint32_t ) target = cpu_to_le32(val);
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	147	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	148	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	149	case 0x0009: // string
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	150	case 0x000a: // octet_string
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	151	dataSize = str.str().size();
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	152	if (dataSize >= targetSize) {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	153	stringstream err;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	154	err << "String too large";
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	155	throw SizeException(err.str());
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	156	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	157	str >> (char *) target;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	158	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	159
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	160	default:
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	161	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	162	stringstream err;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	163	err << "Unknown data type 0x" << hex << type->code;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	164	throw runtime_error(err.str());
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	165	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	166	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	167
1837 32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	168	#if DEBUG
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	169	printRawData(cerr, (const uint8_t *) target, dataSize);
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	170	#endif
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	171
1835 20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	172	return dataSize;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	173	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	174
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	175	/****************************************************************************/
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	176
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	177	void DataTypeHandler::outputData(
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	178	ostream &o,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	179	const DataType *type,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	180	void *data,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	181	size_t dataSize
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	182	)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	183	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	184	if (type->byteSize && dataSize != type->byteSize) {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	185	stringstream err;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	186	err << "Data type mismatch. Expected " << type->name
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	187	<< " with " << type->byteSize << " byte, but got "
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	188	<< dataSize << " byte.";
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	189	throw SizeException(err.str());
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	190	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	191
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	192	o << setfill('0');
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	193
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	194	switch (type->code) {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	195	case 0x0002: // int8
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	196	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	197	int val = (int) (int8_t ) data;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	198	o << "0x" << hex << setw(2) << val
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	199	<< " " << dec << val << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	200	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	201	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	202	case 0x0003: // int16
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	203	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	204	int16_t val = le16_to_cpup(data);
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	205	o << "0x" << hex << setw(4) << val
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	206	<< " " << dec << val << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	207	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	208	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	209	case 0x0004: // int32
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	210	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	211	int32_t val = le32_to_cpup(data);
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	212	o << "0x" << hex << setw(8) << val
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	213	<< " " << dec << val << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	214	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	215	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	216	case 0x0005: // uint8
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	217	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	218	unsigned int val = (unsigned int) (uint8_t ) data;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	219	o << "0x" << hex << setw(2) << val
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	220	<< " " << dec << val << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	221	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	222	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	223	case 0x0006: // uint16
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	224	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	225	uint16_t val = le16_to_cpup(data);
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	226	o << "0x" << hex << setw(4) << val
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	227	<< " " << dec << val << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	228	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	229	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	230	case 0x0007: // uint32
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	231	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	232	uint32_t val = le32_to_cpup(data);
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	233	o << "0x" << hex << setw(8) << val
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	234	<< " " << dec << val << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	235	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	236	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	237	case 0x0009: // string
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	238	o << string((const char *) data, dataSize) << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	239	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	240	case 0x000a: // octet_string
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	241	o << string((const char *) data, dataSize) << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	242	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	243	default:
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	244	printRawData(o, (const uint8_t *) data, dataSize); // FIXME
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	245	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	246	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	247	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	248
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	249	/****************************************************************************/
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	250
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	251	void DataTypeHandler::printRawData(
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	252	ostream &o,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	253	const uint8_t *data,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	254	size_t size
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	255	)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	256	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	257	o << hex << setfill('0');
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	258	while (size--) {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	259	o << "0x" << setw(2) << (unsigned int) *data++;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	260	if (size)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	261	o << " ";
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	262	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	263	o << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	264	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	265
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	266	/****************************************************************************/
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	267
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	268	const DataTypeHandler::DataType DataTypeHandler::dataTypes[] = {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	269	{"int8", 0x0002, 1},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	270	{"int16", 0x0003, 2},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	271	{"int32", 0x0004, 4},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	272	{"uint8", 0x0005, 1},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	273	{"uint16", 0x0006, 2},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	274	{"uint32", 0x0007, 4},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	275	{"string", 0x0009, 0},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	276	{"octet_string", 0x000a, 0},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	277	{"raw", 0xffff, 0},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	278	//{"int64", 8},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	279	//{"uint64", 8},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	280	{}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	281	};
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	282
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	283	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Fri, 05 Mar 2010 15:32:56 +0100
changeset 1837	32136215c1fa
parent 1835	20748e9d2238
child 1868	489ea0becd74
permissions	-rw-r--r--