56 lines
1.0 KiB
C++
56 lines
1.0 KiB
C++
|
/*
|
||
|
|
* uart_protocol.h
|
||
|
|
*
|
||
|
|
* Created on: 02 ÿíâ. 2016 ã.
|
||
|
|
* Author: Sergey
|
||
|
|
*/
|
||
|
|
|
||
|
|
#ifndef UART_PROTOCOL_H_
|
||
|
|
#define UART_PROTOCOL_H_
|
||
|
|
|
||
|
|
#include <cstdint>
|
||
|
|
|
||
|
|
#pragma pack(push, 1)
|
||
|
|
struct UartCommandHeader {
|
||
|
|
uint32_t id;
|
||
|
|
uint8_t payloadSize;
|
||
|
|
};
|
||
|
|
|
||
|
|
struct UartCommand {
|
||
|
|
UartCommandHeader header;
|
||
|
|
static constexpr int MaxPayloadSize = 32;
|
||
|
|
uint8_t payload[MaxPayloadSize];
|
||
|
|
};
|
||
|
|
|
||
|
|
#define FOURCC(a,b,c,d) ( (uint32_t) ((((uint32_t)d)<<24) | (((uint32_t)c)<<16) | (((uint32_t)b)<<8) | ((uint32_t)a)) )
|
||
|
|
|
||
|
|
#pragma pack(pop)
|
||
|
|
|
||
|
|
struct UartCommandReader{
|
||
|
|
uint32_t offset;
|
||
|
|
UartCommand* cmd;
|
||
|
|
UartCommandReader(UartCommand* _cmd):offset(0), cmd(_cmd){
|
||
|
|
}
|
||
|
|
|
||
|
|
template<typename T>
|
||
|
|
T read(){
|
||
|
|
return *((T*)&cmd->payload[offset++]);
|
||
|
|
}
|
||
|
|
};
|
||
|
|
|
||
|
|
struct UartCommandWriter{
|
||
|
|
UartCommand* cmd;
|
||
|
|
UartCommandWriter(UartCommand* _cmd) : cmd(_cmd){
|
||
|
|
cmd->header.payloadSize = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
template<typename T>
|
||
|
|
UartCommandWriter& write(const T& val){
|
||
|
|
((T*)&cmd->payload[cmd->header.payloadSize])[0] = val;
|
||
|
|
cmd->header.payloadSize += sizeof(T);
|
||
|
|
return *this;
|
||
|
|
}
|
||
|
|
};
|
||
|
|
|
||
|
|
#endif /* UART_PROTOCOL_H_ */
|