started working on aqhome-data.
this will be the data daemon storing datapoints, accessable via IPC.
This commit is contained in:
218
aqhome/ipc/data/msg_data_datapoints.c
Normal file
218
aqhome/ipc/data/msg_data_datapoints.c
Normal file
@@ -0,0 +1,218 @@
|
||||
/****************************************************************************
|
||||
* This file is part of the project AqHome.
|
||||
* AqHome (c) by 2023 Martin Preuss, all rights reserved.
|
||||
*
|
||||
* The license for this file can be found in the file COPYING which you
|
||||
* should have received along with this file.
|
||||
****************************************************************************/
|
||||
|
||||
#ifdef HAVE_CONFIG_H
|
||||
# include <config.h>
|
||||
#endif
|
||||
|
||||
#include <aqhome/ipc/data/msg_data_datapoints.h>
|
||||
#include <aqhome/ipc/data/ipc_data.h>
|
||||
|
||||
#include <gwenhywfar/msg.h>
|
||||
#include <gwenhywfar/buffer.h>
|
||||
|
||||
#include <gwenhywfar/debug.h>
|
||||
#include <gwenhywfar/msg_ipc.h>
|
||||
|
||||
#include <string.h>
|
||||
|
||||
|
||||
#define AQH_MSGDATA_DATAPOINTS_OFFS_FLAGS 0 /* 4 bytes */
|
||||
#define AQH_MSGDATA_DATAPOINTS_OFFS_NUMVALUES 4 /* 4 bytes */
|
||||
|
||||
#define AQH_MSGDATA_DATAPOINTS_OFFS_VALUEID 8 /* 8 byte */
|
||||
#define AQH_MSGDATA_DATAPOINTS_OFFS_VALUENAME 16 /* 104 byte */
|
||||
# define AQH_MSGDATA_DATAPOINTS_SIZE_VALUENAME 104
|
||||
#define AQH_MSGDATA_DATAPOINTS_OFFS_VALUEUNITS 120 /* 16 byte */
|
||||
# define AQH_MSGDATA_DATAPOINTS_SIZE_VALUEUNITS 16
|
||||
#define AQH_MSGDATA_DATAPOINTS_OFFS_VALUES 136
|
||||
|
||||
|
||||
|
||||
#define AQH_MSGDATA_DATAPOINTS_MINSIZE (GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_OFFS_VALUES)
|
||||
|
||||
|
||||
static void _writeQword(uint64_t i64, uint8_t *ptr);
|
||||
|
||||
|
||||
|
||||
|
||||
GWEN_MSG *AQH_DataPointsDataIpcMsg_new(uint16_t code, uint32_t flags,
|
||||
uint64_t valueId, const char *valueName, const char *units,
|
||||
const uint64_t *i64Ptr, int numOfDataPoints)
|
||||
{
|
||||
GWEN_MSG *msg;
|
||||
uint8_t *ptr;
|
||||
int payloadSize;
|
||||
int i;
|
||||
|
||||
payloadSize=AQH_MSGDATA_DATAPOINTS_OFFS_VALUES+(numOfDataPoints*16);
|
||||
|
||||
msg=GWEN_IpcMsg_new(AQH_IPC_PROTOCOL_DATA_ID, AQH_IPC_PROTOCOL_DATA_VERSION, code, payloadSize, NULL);
|
||||
ptr=GWEN_Msg_GetBuffer(msg)+GWEN_MSGIPC_OFFS_PAYLOAD;
|
||||
*(ptr++)=flags & 0xff;
|
||||
*(ptr++)=(flags>>8) & 0xff;
|
||||
*(ptr++)=(flags>>16) & 0xff;
|
||||
*(ptr++)=(flags>>24) & 0xff;
|
||||
|
||||
*(ptr++)=numOfDataPoints & 0xff;
|
||||
*(ptr++)=(numOfDataPoints>>8) & 0xff;
|
||||
*(ptr++)=(numOfDataPoints>>16) & 0xff;
|
||||
*(ptr++)=(numOfDataPoints>>24) & 0xff;
|
||||
|
||||
_writeQword(valueId, ptr);
|
||||
ptr+=8;
|
||||
|
||||
|
||||
if (valueName) {
|
||||
strncpy((char*) ptr, valueName, AQH_MSGDATA_DATAPOINTS_SIZE_VALUENAME-1);
|
||||
ptr[AQH_MSGDATA_DATAPOINTS_SIZE_VALUENAME-1]=0;
|
||||
}
|
||||
else
|
||||
memset(ptr, 0, AQH_MSGDATA_DATAPOINTS_SIZE_VALUENAME);
|
||||
ptr+=AQH_MSGDATA_DATAPOINTS_SIZE_VALUENAME;
|
||||
|
||||
if (units) {
|
||||
strncpy((char*) ptr, units, AQH_MSGDATA_DATAPOINTS_SIZE_VALUEUNITS-1);
|
||||
ptr[AQH_MSGDATA_DATAPOINTS_SIZE_VALUEUNITS-1]=0;
|
||||
}
|
||||
else
|
||||
memset(ptr, 0, AQH_MSGDATA_DATAPOINTS_SIZE_VALUEUNITS);
|
||||
ptr+=AQH_MSGDATA_DATAPOINTS_SIZE_VALUEUNITS;
|
||||
|
||||
|
||||
for (i=0; i<numOfDataPoints; i++) {
|
||||
_writeQword(*i64Ptr, ptr);
|
||||
i64Ptr++;
|
||||
ptr+=8;
|
||||
|
||||
_writeQword(*i64Ptr, ptr);
|
||||
i64Ptr++;
|
||||
ptr+=8;
|
||||
}
|
||||
return msg;
|
||||
}
|
||||
|
||||
|
||||
|
||||
void _writeQword(uint64_t i64, uint8_t *ptr)
|
||||
{
|
||||
*(ptr++)=i64 & 0xff;
|
||||
*(ptr++)=(i64>>8) & 0xff;
|
||||
*(ptr++)=(i64>>16) & 0xff;
|
||||
*(ptr++)=(i64>>24) & 0xff;
|
||||
*(ptr++)=(i64>>32) & 0xff;
|
||||
*(ptr++)=(i64>>40) & 0xff;
|
||||
*(ptr++)=(i64>>48) & 0xff;
|
||||
*(ptr++)=(i64>>56) & 0xff;
|
||||
}
|
||||
|
||||
|
||||
|
||||
uint32_t AQH_DataPointsDataIpcMsg_GetFlags(const GWEN_MSG *msg)
|
||||
{
|
||||
return GWEN_Msg_GetUint32At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_OFFS_FLAGS, 0);
|
||||
}
|
||||
|
||||
|
||||
|
||||
uint32_t AQH_DataPointsDataIpcMsg_GetNumValues(const GWEN_MSG *msg)
|
||||
{
|
||||
return GWEN_Msg_GetUint32At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_OFFS_NUMVALUES, 0);
|
||||
}
|
||||
|
||||
|
||||
|
||||
uint64_t AQH_DataPointsDataIpcMsg_GetValueId(const GWEN_MSG *msg)
|
||||
{
|
||||
return GWEN_Msg_GetUint64At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_OFFS_VALUEID, 0);
|
||||
}
|
||||
|
||||
|
||||
|
||||
const char *AQH_DataPointsDataIpcMsg_GetValueName(const GWEN_MSG *msg)
|
||||
{
|
||||
if (GWEN_Msg_GetBytesInBuffer(msg)>=GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_MINSIZE)
|
||||
return (const char*) (GWEN_Msg_GetConstBuffer(msg)+GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_OFFS_VALUENAME);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
|
||||
|
||||
const char *AQH_DataPointsDataIpcMsg_GetUnits(const GWEN_MSG *msg)
|
||||
{
|
||||
if (GWEN_Msg_GetBytesInBuffer(msg)>=GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_MINSIZE)
|
||||
return (const char*) (GWEN_Msg_GetConstBuffer(msg)+GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_OFFS_VALUEUNITS);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
|
||||
|
||||
const uint64_t *AQH_DataPointsDataIpcMsg_GetDataPoints(const GWEN_MSG *msg)
|
||||
{
|
||||
if (GWEN_Msg_GetBytesInBuffer(msg)>=GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_MINSIZE)
|
||||
return (const uint64_t*) (GWEN_Msg_GetConstBuffer(msg)+GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_OFFS_VALUES);
|
||||
return NULL;
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
int AQH_DataPointsDataIpcMsg_IsValid(const GWEN_MSG *msg)
|
||||
{
|
||||
int msgLen;
|
||||
int numValues;
|
||||
const uint8_t *ptr;
|
||||
|
||||
msgLen=GWEN_Msg_GetBytesInBuffer(msg);
|
||||
if (msgLen<AQH_MSGDATA_DATAPOINTS_MINSIZE) {
|
||||
DBG_ERROR(AQH_LOGDOMAIN, "Message too small (%d<%d)", GWEN_Msg_GetBytesInBuffer(msg), AQH_MSGDATA_DATAPOINTS_MINSIZE);
|
||||
return 0;
|
||||
}
|
||||
|
||||
numValues=(int)AQH_DataPointsDataIpcMsg_GetNumValues(msg);
|
||||
if (msgLen<(numValues*16)+AQH_MSGDATA_DATAPOINTS_OFFS_VALUES+GWEN_MSGIPC_OFFS_PAYLOAD) {
|
||||
DBG_ERROR(AQH_LOGDOMAIN, "Message too small to contain %d values", numValues);
|
||||
return 0;
|
||||
}
|
||||
|
||||
ptr=GWEN_Msg_GetConstBuffer(msg);
|
||||
if (ptr[GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_OFFS_VALUENAME+AQH_MSGDATA_DATAPOINTS_SIZE_VALUENAME-1]!=0) {
|
||||
DBG_ERROR(AQH_LOGDOMAIN, "Name string for value is not null-terminated");
|
||||
return 0;
|
||||
}
|
||||
|
||||
if (ptr[GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGDATA_DATAPOINTS_OFFS_VALUEUNITS+AQH_MSGDATA_DATAPOINTS_SIZE_VALUEUNITS-1]!=0) {
|
||||
DBG_ERROR(AQH_LOGDOMAIN, "Units string for value is not null-terminated");
|
||||
return 0;
|
||||
}
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
|
||||
|
||||
void AQH_DataPointsDataIpcMsg_DumpToBuffer(const GWEN_MSG *msg, GWEN_BUFFER *dbuf, const char *sText)
|
||||
{
|
||||
if (GWEN_Msg_GetBytesInBuffer(msg)>=AQH_MSGDATA_DATAPOINTS_MINSIZE) {
|
||||
GWEN_Buffer_AppendArgs(dbuf,
|
||||
"DATAPOINTS (code=%d, proto=%d, proto version=%d, flags=0x%08x, values=%d)\n",
|
||||
GWEN_IpcMsg_GetCode(msg),
|
||||
GWEN_IpcMsg_GetProtoId(msg),
|
||||
GWEN_IpcMsg_GetProtoVersion(msg),
|
||||
(unsigned int)AQH_DataPointsDataIpcMsg_GetFlags(msg),
|
||||
AQH_DataPointsDataIpcMsg_GetNumValues(msg));
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user