diff -r 7fdc9a71d314 -r 8ad140f3dd41 hti/PC_Tools/HTIGateway/HtiGateway/src/HtiMessage.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/hti/PC_Tools/HTIGateway/HtiGateway/src/HtiMessage.cpp	Wed Oct 13 16:17:58 2010 +0300
@@ -0,0 +1,228 @@
+/*
+* Copyright (c) 2009 Nokia Corporation and/or its subsidiary(-ies). 
+* All rights reserved.
+* This component and the accompanying materials are made available
+* under the terms of "Eclipse Public License v1.0"
+* which accompanies this distribution, and is available
+* at the URL "http://www.eclipse.org/legal/epl-v10.html".
+*
+* Initial Contributors:
+* Nokia Corporation - initial contribution.
+*
+* Contributors:
+* 
+* Description:
+*   This file contains implementation of HtiMessage class.
+*/
+
+#include "htimessage.h"
+#include "crc16.h"
+#include <memory.h>
+#include <crtdbg.h>
+#include <stdio.h>
+
+static const BYTE HTI_ERR_CMD = 0xFF;
+static const int HTI_MIN_ERR_MSG_SIZE = 10;
+static const int HTI_MAX_ERR_MSG_SIZE = 0xFF;
+
+
+HtiMessage::HtiMessage(DWORD serviceId, void* body, DWORD len, BYTE priority)
+{
+	m_ErrDescr = NULL;
+	m_Size = len + KMsgHeaderMinSize;
+	m_Message = new BYTE[m_Size];
+	//_RPT1(_CRT_WARN,"HtiMessage::HtiMessage %x\n", body);
+	//_RPT2(_CRT_WARN,"HtiMessage::HtiMessage m_Message %x <%d>\n", m_Message, m_Size);
+	memset(m_Message, 0, KMsgHeaderMinSize);
+	memcpy(m_Message + KMsgHeaderMinSize, body, len);
+	*((DWORD*)(m_Message + KMsgServiceNameOffset)) = serviceId;
+	*((DWORD*)(m_Message + KMsgBodySizeOffset)) = len;
+	m_Message[KMsgVersionOffset] = KDefaultVersion;
+	m_Message[KMsgPriorityOffset] = priority;
+	//CRC
+	*((WORD*)(m_Message + KMsgCrcOffset)) = CRC16CCITT(m_Message, KMsgHeaderMinSize-2);
+}
+
+HtiMessage::HtiMessage(void* message, DWORD len)
+{
+	m_ErrDescr = NULL;
+	BYTE* srcMsg = (BYTE*)message;
+    int extSize = srcMsg[KMsgExtSizeOffset];
+    int headerSize = MinHeaderSize() + extSize;
+
+    m_Size = *((DWORD*)(srcMsg + KMsgBodySizeOffset));
+	m_Size += headerSize;
+    
+    //allocate header space
+    m_Message = new BYTE[m_Size];
+	//_RPT1(_CRT_WARN,"HtiMessage::HtiMessage %x \n", message);
+	//_RPT2(_CRT_WARN,"HtiMessage::HtiMessage m_Message %x <%d>\n", m_Message, m_Size);
+    
+    //copy message
+	m_MessageReminderSize = m_Size;
+	AddToBody( message, len);
+	//memcpy( m_Message, message, min(m_MessageReminderSize, len) );
+	//m_MessageReminderSize -= min(m_MessageReminderSize, len);
+}
+
+DWORD HtiMessage::AddToBody(void* data, DWORD len)
+{
+	//_RPT1(_CRT_WARN,"HtiMessage::AddToBody %x\n", data);
+	DWORD copyLen = min(m_MessageReminderSize, len);
+	memcpy( m_Message + m_Size - m_MessageReminderSize, data, copyLen);
+	m_MessageReminderSize -= copyLen;
+	return copyLen;
+
+/*
+	if ( m_MessageReminderSize <= len) //last part
+	{
+		memcpy(m_Message + m_Size - m_MessageReminderSize, data, m_MessageReminderSize);
+		DWORD copyLen = m_MessageReminderSize;
+		m_MessageReminderSize = 0;
+		return copyLen;
+	}
+	else //in the middle
+	{
+		memcpy(m_Message + m_Size - m_MessageReminderSize, data, len);
+		m_MessageReminderSize -= len;
+	}
+
+	return len;
+*/
+}
+
+HtiMessage::~HtiMessage()
+{
+	//_RPT1(_CRT_WARN,"~HtiMessage err %x\n", m_ErrDescr);
+	//_RPT1(_CRT_WARN,"~HtiMessage msg %x\n", m_Message);
+	delete[] m_ErrDescr;
+	delete[] m_Message;
+}
+
+/**
+* Returns whole HTI message including header
+*/
+void* HtiMessage::HtiData()
+{
+	return m_Message;
+}
+
+DWORD HtiMessage::HtiDataSize()
+{
+	return m_Size;
+}
+
+DWORD HtiMessage::GetBodySize()
+{
+	return  *((DWORD*)(m_Message + KMsgBodySizeOffset));
+}
+
+DWORD HtiMessage::GetExtSize()
+{
+	return m_Message[KMsgExtSizeOffset];
+}
+
+int HtiMessage::GetBodyStart()
+{
+	return GetExtSize()+MinHeaderSize();
+}
+
+void* HtiMessage::GetBody()
+{
+	return m_Message+GetBodyStart();
+}
+
+DWORD HtiMessage::GetServiceUID()
+{
+	return *((DWORD*)(m_Message + KMsgServiceNameOffset));
+}
+
+bool HtiMessage::CheckValidHtiHeader(void* header)
+{
+	//check CRC16
+	WORD headerCrc16 = *((WORD*)((BYTE*)header+KMsgCrcOffset));
+	WORD calcCrc16 = CRC16CCITT(header, KMsgCrcOffset);
+
+	return headerCrc16 == calcCrc16;
+}
+
+DWORD HtiMessage::ExtractMsgSizeFromHeader(void* header)
+{
+	return *((DWORD*)(((BYTE*)header)+KMsgBodySizeOffset));
+}
+
+int HtiMessage::MinHeaderSize()
+{
+	return KMsgHeaderMinSize;
+}
+
+HtiMessage* HtiMessage::CreateErrorMessage(int errorCode, const char* errDescr)
+{
+	BYTE* msg = new BYTE[ HTI_MAX_ERR_MSG_SIZE ];
+	memset(msg, 0, HTI_MAX_ERR_MSG_SIZE );
+	msg[0] = HTI_ERR_CMD;
+	*((DWORD*)(msg + HtiServiceErrCodeOffset)) = errorCode;
+	*((DWORD*)(msg + HtiErrServiceUidOffset)) = HTI_SYSTEM_SERVICE_UID;
+	int descrLen = min(strlen( errDescr ), HTI_MAX_ERR_MSG_SIZE - HtiErrDescrOffset );
+	memcpy( msg + HtiErrDescrOffset,
+			errDescr,
+			descrLen
+			);
+	HtiMessage* newMsg = new HtiMessage(HTI_SYSTEM_SERVICE_UID,
+										msg,
+										descrLen + HtiErrDescrOffset + MinHeaderSize());
+	return newMsg;
+}
+
+bool HtiMessage::IsErrorMessage()
+{
+	if ( m_Message )
+	{
+		return GetServiceUID() == HTI_SYSTEM_SERVICE_UID &&
+		   m_Message[GetBodyStart()] == HTI_ERR_CMD &&
+		   GetBodySize()>= HTI_MIN_ERR_MSG_SIZE ;
+	}
+	return false;
+}
+
+int HtiMessage::HtiErrorCode()
+{
+	if ( IsErrorMessage() )
+	{
+		return m_Message[GetBodyStart()+HtiErrCodeOffset];
+	}
+	return -1;
+}
+int HtiMessage::ServiceErrorCode()
+{
+	if ( IsErrorMessage() )
+	{
+		return  *((DWORD*)(m_Message + GetBodyStart() + HtiServiceErrCodeOffset));
+	}
+	return -1;
+}
+
+char* HtiMessage::ErrorDescription()
+{
+	if ( IsErrorMessage() )
+	{
+		int desrLen = GetBodySize() - HtiErrDescrOffset;
+		m_ErrDescr = new char[desrLen+1];
+		//_RPT2(_CRT_WARN,"HtiMessage::ErrorDescription %x <%d>\n", m_ErrDescr, desrLen+1);
+		memcpy( m_ErrDescr,
+				m_Message + GetBodyStart() + HtiErrDescrOffset,
+				desrLen );
+		m_ErrDescr[desrLen] = 0;
+		return m_ErrDescr;
+	}
+	return NULL;
+}
+
+int HtiMessage::ErrorServiceUid()
+{
+	if ( IsErrorMessage() )
+	{
+		return  *((DWORD*)(m_Message + GetBodyStart() + HtiErrServiceUidOffset));
+	}
+	return -1;
+}
\ No newline at end of file