Subversion Repositories HomeAutomation

/***************************************************************************

 *   Copyright (C) November 28, 2008 by Mattias Runge                             *

 *   mattias@runge.se                                                      *

 *   canmessage.cpp                                            *

 *                                                                         *

 *   This program is free software; you can redistribute it and/or modify  *

 *   it under the terms of the GNU General Public License as published by  *

 *   the Free Software Foundation; either version 2 of the License, or     *

 *   (at your option) any later version.                                   *

 *                                                                         *

 *   This program is distributed in the hope that it will be useful,       *

 *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *

 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *

 *   GNU General Public License for more details.                          *

 *                                                                         *

 *   You should have received a copy of the GNU General Public License     *

 *   along with this program; if not, write to the                         *

 *   Free Software Foundation, Inc.,                                       *

 *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *

 ***************************************************************************/

#include <string>

#include <iostream>

#include "canidtranslator.h"

#include "canmessage.h"

void CanMessage::setRaw(string rawHex)

{

	CanIdTranslator &translator = CanIdTranslator::getInstance();

	//SyslogStream &slog = SyslogStream::getInstance();

	//PKT 00060102 1 0 00 00 c4

	rawHex = trim(rawHex, '\n');

	rawHex = trim(rawHex);

	myRawHex = rawHex;

	vector<string> parts = explode(" ", rawHex);

	if (parts.size() < 2 || parts[0].compare("PKT") != 0)

	{

		cout << "Malformed can message received from canDaemon: \"" << rawHex << "\"\n";

		throw new CanMessageException("Malformed can message received from canDaemon");

	}

	string rawHeaderBin = hex2bin(parts[1]);

	try

	{

		myClassName = translator.lookupClassName(bin2uint(rawHeaderBin.substr(3, 4)));

	}

	catch (std::out_of_range& e)

	{

		cout << "DEBUG: setRaw exception: " << e.what() << "\n";

		cout << "DEBUG: A rawHeaderBin=" << rawHeaderBin << endl;

	}

	if (myClassName == "")

	{

		myIsUnknown = true;

		return;

	}

	else

	{

		myIsUnknown = false;

	}

	string rawHexData = "";

	for (int n = 4; n < parts.size(); n++)

	{

		rawHexData += parts[n];

	}

	if (myClassName == "nmt")

	{

		int commandId;

		try

		{

			commandId = bin2uint(rawHeaderBin.substr(8, 8));

		}

		catch (std::out_of_range& e)

		{

			cout << "DEBUG: setRaw exception: " << e.what() << "\n";

			cout << "DEBUG: B rawHeaderBin=" << rawHeaderBin << endl;

		}

		myCommandName = translator.lookupNMTCommandName(commandId);

		myData = translator.translateNMTData(commandId, rawHexData);

		myDirectionFlag = "";

		myModuleName = "";

		myModuleId = 0;

	}

	else

	{

		try

		{

			myDirectionFlag = translator.lookupDirectionFlag(bin2uint(rawHeaderBin.substr(7, 1)));

		}

		catch (std::out_of_range& e)

		{

			cout << "DEBUG: setRaw exception: " << e.what() << "\n";

			cout << "DEBUG: C rawHeaderBin=" << rawHeaderBin << endl;

		}

		try

		{

			myModuleName = translator.lookupModuleName(bin2uint(rawHeaderBin.substr(8, 8)));

		}

		catch (std::out_of_range& e)

		{

			cout << "DEBUG: setRaw exception: " << e.what() << "\n";

			cout << "DEBUG: D rawHeaderBin=" << rawHeaderBin << endl;

		}

		try

		{

			myModuleId = bin2uint(rawHeaderBin.substr(16, 8));

		}

		catch (std::out_of_range& e)

		{

			cout << "DEBUG: setRaw exception: " << e.what() << "\n";

			cout << "DEBUG: E rawHeaderBin=" << rawHeaderBin << endl;

		}

		int commandId;

		try

		{

			commandId = bin2uint(rawHeaderBin.substr(24, 8));

		}

		catch (std::out_of_range& e)

		{

			cout << "DEBUG: setRaw exception: " << e.what() << "\n";

			cout << "DEBUG: F rawHeaderBin=" << rawHeaderBin << endl;

		}

		myCommandName = translator.lookupCommandName(commandId, myModuleName);

		myData = translator.translateData(commandId, myModuleName, rawHexData);

	}

}

string CanMessage::getRaw()

{

	CanIdTranslator &translator = CanIdTranslator::getInstance();

	string dataHex;

	string rawHex = "PKT ";

	string bin = "000";

	int classId = translator.resolveClassId(myClassName);

	if (classId == -1)

		bin += "0000";

	else

		bin += uint2bin(classId, 4);

	if (myClassName == "nmt")

	{

		bin +="0";

		int commandNameId = translator.resolveNMTCommandId(myCommandName);

		if (commandNameId == -1)

			bin += "00000000";

		else

			bin += uint2bin(commandNameId, 8);

		bin += "0000000000000000";

		dataHex = translator.translateNMTDataToHex(commandNameId, myData);

	}

	else

	{

		bin += uint2bin(translator.resolveDirectionFlag(myDirectionFlag), 1);

		int moduleTypeId = translator.resolveModuleId(myModuleName);

		if (moduleTypeId == -1)

			bin += "00000000";

		else

			bin += uint2bin(moduleTypeId, 8);

		int moduleId = myModuleId;

		bin += uint2bin(moduleId, 8);

		int commandNameId = translator.resolveCommandId(myCommandName, myModuleName);

		if (commandNameId == -1)

			bin += "00000000";

		else

			bin += uint2bin(commandNameId, 8);

		dataHex = translator.translateDataToHex(commandNameId, myModuleName, myData);

	}

	rawHex += bin2hex(bin);

	rawHex += " 1 0";

	while (dataHex.size() > 0)

	{

		string hex;

		try

		{

			hex = dataHex.substr(0, 2);

		}

		catch (std::out_of_range& e)

		{

			cout << "DEBUG: getRaw exception: " << e.what() << "\n";

			cout << "DEBUG: A dataHex=" << dataHex << endl;

			continue;

		}

		dataHex.erase(0, 2);

		rawHex += " " + hex;

	}

	rawHex += "\n";

	return rawHex;

}

void CanMessage::setData(map<string, CanVariable> data)

{

	myData = data;

	CanIdTranslator &translator = CanIdTranslator::getInstance();

	int commandNameId = translator.resolveNMTCommandId(myCommandName);

	if (myClassName == "nmt")

	{

		translator.makeNMTDataValid(commandNameId, data);

	}

	else

	{

		translator.makeDataValid(commandNameId, myModuleName, data);

	}

}

string CanMessage::getJSONData()

{

	string json = "{";

	map<string, CanVariable>::iterator iter;

	for (iter = myData.begin(); iter != myData.end(); iter++)

	{

		json += " " + iter->first + " : ";

		if (iter->second.getType() == "uint")

		{

			json += iter->second.getValue();

		}

		else if (iter->second.getType() == "float")

		{

			json += iter->second.getValue();

		}

		else if (iter->second.getType() == "ascii" || iter->second.getType() == "hexstring")

		{

			json += "'" + escape(iter->second.getValue()) + "'";

		}

		json += ",";

	}

	json = trim(json, ',');

	return json + " }";

}

string CanMessage::toString()

{

	string result = "[CanMessage] ClassName: " + myClassName + "\n";

	result += "             DirectionFlag: " + myDirectionFlag + "\n";

	result += "             ModuleName: " + myModuleName + "\n";

	result += "             ModuleId: " + itos(myModuleId) + "\n";

	result += "             CommandName: " + myCommandName + "\n";

	result += "             Data: " + getJSONData() + "\n";

	result += "             RawHex: " + myRawHex + "\n";

	return result;

}