hm_packets.cpp

#include "Arduino.h"

#include "hm_crc.h"
#include "hm_packets.h"

void HM_Packets::SetUnixTimeStamp(uint32_t ts)
{
	unixTimeStamp = ts;
}

void HM_Packets::UnixTimeStampTick()
{
	unixTimeStamp++;
}

void HM_Packets::prepareBuffer(uint8_t *buf)
{
	// minimal buffer size of 32 bytes is assumed
	memset(buf, 0x00, 32);
}

void HM_Packets::copyToBuffer(uint8_t *buf, uint32_t val)
{
	buf[0]= (uint8_t)(val >> 24);
	buf[1]= (uint8_t)(val >> 16);
	buf[2]= (uint8_t)(val >> 8);
	buf[3]= (uint8_t)(val & 0xFF);
}

void HM_Packets::copyToBufferBE(uint8_t *buf, uint32_t val)
{
 	memcpy(buf, &val, sizeof(uint32_t));
}


// int32_t HM_Packets::GetTimePacket(uint8_t *buf, uint32_t wrAdr, uint32_t dtuAdr)
// {
//	prepareBuffer(buf);
//
//	buf[0] = 0x15;
//	copyToBufferBE(&buf[1], wrAdr);
//	copyToBufferBE(&buf[5], dtuAdr);
//	buf[9] = 0x80;
//    buf[10] = 0x0B;        //0x0B;  0x03 0x11
//	buf[11] = 0x00;
//
//	copyToBuffer(&buf[12], unixTimeStamp);
//
//	buf[19] = 0x05;
//
//	// CRC16
//	uint16_t crc16 = crc16_modbus(&buf[10], 14);
//	buf[24] = crc16 >> 8;
//	buf[25] = crc16 & 0xFF;
//
//	// crc8
//	buf[26] = crc8(&buf[0], 26);
//
//	return 27;
//}

#define MAX_RF_PAYLOAD_SIZE 32

int32_t HM_Packets::GetCmdPacket(uint8_t *buf, uint32_t wrAdr, uint32_t dtuAdr, uint8_t mid, uint8_t CmdAndUsrData[],uint8_t anzByteUsrData )
{   uint8_t i=0;
  memset(buf, 0, MAX_RF_PAYLOAD_SIZE);
	buf[0] = mid;
	copyToBufferBE(&buf[1], wrAdr);
	copyToBufferBE(&buf[5], dtuAdr);
    for (i; i < anzByteUsrData; i++){
      buf[i+9]  = CmdAndUsrData[i];
      //Serial.print(i+9,DEC);Serial.print(":");Serial.print(buf[i+9],HEX);Serial.print(":");
      //Serial.println(CmdAndUsrData[i],HEX);
      }

	// crc8
	buf[i+9] = crc8(buf, i+9);  //toe buf[10]

	return i+10;
}