etherlabmaster: tool/DataTypeHandler.cpp@489ea0becd74 (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
1868 489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	67	string DataTypeHandler::typeInfo()
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	68	{
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	69	stringstream s;
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	70
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	71	s
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	72	<< "These are valid data types to use with" << endl
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	73	<< "the --type option:" << endl
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	74	<< " int8, int16, int32, uint8, uint16, uint32, string," << endl
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	75	<< " octet_string." << endl;
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	76	return s.str();
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	77	}
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	78
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	79	/****************************************************************************/
489ea0becd74 Implemented SoE IDN parser for strings like 'P-0-0150'; moved data type Florian Pose <fp@igh-essen.com> parents: 1837 diff changeset	80
1835 20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	81	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	82	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	83	const DataType *d;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	84
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	85	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	86	if (code == d->code)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	87	return d;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	88
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	89	return NULL;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	90	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	91
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	92	/****************************************************************************/
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	93
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	94	size_t DataTypeHandler::interpretAsType(
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	95	const DataType *type,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	96	const string &source,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	97	void *target,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	98	size_t targetSize
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	99	)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	100	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	101	stringstream str;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	102	size_t dataSize = type->byteSize;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	103
1837 32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	104	#if DEBUG
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	105	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	106	#endif
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	107
1835 20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	108	str << source;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	109	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	110	str.exceptions(ios::failbit);
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	111
1837 32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	112	#if DEBUG
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	113	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	114	#endif
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	115
1835 20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	116	switch (type->code) {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	117	case 0x0002: // int8
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	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	120	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	121	if (val > 127 \|\| val < -128)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	122	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	123	(uint8_t ) target = 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 0x0003: // int16
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	int16_t val;
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	(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	131	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	132	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	133	case 0x0004: // int32
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	int32_t val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	136	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	137	(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	138	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	139	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	140	case 0x0005: // uint8
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	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	143	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	144	if (val > 0xff)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	145	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	146	(uint8_t ) target = 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 0x0006: // uint16
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	150	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	151	uint16_t val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	152	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	153	(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	154	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	155	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	156	case 0x0007: // uint32
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	157	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	158	uint32_t val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	159	str >> val;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	160	(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	161	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	162	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	163	case 0x0009: // string
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	164	case 0x000a: // octet_string
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	165	dataSize = str.str().size();
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	166	if (dataSize >= targetSize) {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	167	stringstream err;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	168	err << "String too large";
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	169	throw SizeException(err.str());
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	170	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	171	str >> (char *) target;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	172	break;
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	default:
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	stringstream err;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	177	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	178	throw runtime_error(err.str());
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	179	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	180	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	181
1837 32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	182	#if DEBUG
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	183	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	184	#endif
32136215c1fa Implemented SoE write state machine and soe_write command. Florian Pose <fp@igh-essen.com> parents: 1835 diff changeset	185
1835 20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	186	return dataSize;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	187	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	188
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	189	/****************************************************************************/
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	void DataTypeHandler::outputData(
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	192	ostream &o,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	193	const DataType *type,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	194	void *data,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	195	size_t dataSize
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	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	198	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	199	stringstream err;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	200	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	201	<< " 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	202	<< dataSize << " byte.";
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	203	throw SizeException(err.str());
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	204	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	205
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	206	o << setfill('0');
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	switch (type->code) {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	209	case 0x0002: // int8
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	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	212	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	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 0x0003: // int16
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	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	219	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	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 0x0004: // int32
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	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	226	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	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 0x0005: // uint8
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	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	233	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	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 0x0006: // uint16
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	238	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	239	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	240	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	241	<< " " << dec << val << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	242	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	243	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	244	case 0x0007: // uint32
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	245	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	246	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	247	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	248	<< " " << dec << val << endl;
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	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	251	case 0x0009: // string
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	252	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	253	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	254	case 0x000a: // octet_string
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	255	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	256	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	257	default:
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	258	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	259	break;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	260	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	261	}
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	/****************************************************************************/
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	void DataTypeHandler::printRawData(
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	266	ostream &o,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	267	const uint8_t *data,
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	268	size_t size
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	269	)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	270	{
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	271	o << hex << setfill('0');
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	272	while (size--) {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	273	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	274	if (size)
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	275	o << " ";
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	276	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	277	o << endl;
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	278	}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	279
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	const DataTypeHandler::DataType DataTypeHandler::dataTypes[] = {
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	283	{"int8", 0x0002, 1},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	284	{"int16", 0x0003, 2},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	285	{"int32", 0x0004, 4},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	286	{"uint8", 0x0005, 1},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	287	{"uint16", 0x0006, 2},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	288	{"uint32", 0x0007, 4},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	289	{"string", 0x0009, 0},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	290	{"octet_string", 0x000a, 0},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	291	{"raw", 0xffff, 0},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	292	//{"int64", 8},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	293	//{"uint64", 8},
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	294	{}
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	295	};
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	296
20748e9d2238 Sourced out data type handling into an own class. Florian Pose <fp@igh-essen.com> parents: diff changeset	297	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Thu, 11 Mar 2010 14:29:43 +0100
changeset 1868	489ea0becd74
parent 1837	32136215c1fa
child 1871	04ea48971eed
permissions	-rw-r--r--