/****************************************************************************
 * 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/nodes/msg_ipc_getdevices_rsp.h>

#include <gwenhywfar/msg.h>
#include <gwenhywfar/buffer.h>

#include <gwenhywfar/misc.h>
#include <gwenhywfar/list.h>
#include <gwenhywfar/error.h>
#include <gwenhywfar/debug.h>
#include <gwenhywfar/text.h>
#include <gwenhywfar/msg_ipc.h>


#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_FLAGS       0   /* 1 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_BUSADDR     1   /* 1 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_UID         2   /* 4 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_MANUF       6   /* 4 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_DEVTYPE    10   /* 2 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_DEVVER     12   /* 2 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_FWVER      14   /* 4 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_LASTCHG    18   /* 8 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_PKGOUT     26   /* 2 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_PKGIN      28   /* 2 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_COLLISIONS 30   /* 2 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_BUSY       32   /* 2 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_CRC        34   /* 2 bytes */
#define AQH_MSGIPC_GETDEVICES_RSP_OFFS_IO         36   /* 2 bytes */


#define AQH_MSGIPC_GETDEVICES_RSP_MINSIZE          (GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_LASTCHG+8)


static void _addU16t(uint8_t **pPtr, uint16_t i);
static void _addU32t(uint8_t **pPtr, uint32_t i);
static void _addU64t(uint8_t **pPtr, uint64_t i);



GWEN_MSG *AQH_GetDevicesResponseIpcMsg_new(uint16_t code, uint8_t flags, const AQH_NODE_INFO *ni)
{
  GWEN_MSG *msg;
  uint8_t *ptr;
  const GWEN_TIMESTAMP *t;

  msg=GWEN_IpcMsg_new(AQH_IPC_PROTOCOL_NODES_ID, AQH_IPC_PROTOCOL_NODES_VERSION, code, AQH_MSGIPC_GETDEVICES_RSP_MINSIZE, NULL);
  ptr=GWEN_Msg_GetBuffer(msg)+GWEN_MSGIPC_OFFS_PAYLOAD;

  *(ptr++)=flags & 0xff;

  *(ptr++)=AQH_NodeInfo_GetBusAddress(ni);
  _addU32t(&ptr, AQH_NodeInfo_GetUid(ni));

  _addU32t(&ptr, AQH_NodeInfo_GetManufacturer(ni));
  _addU16t(&ptr, AQH_NodeInfo_GetDeviceType(ni));
  _addU16t(&ptr, AQH_NodeInfo_GetDeviceVersion(ni));
  _addU32t(&ptr, AQH_NodeInfo_GetFirmwareVersion(ni));
  t=AQH_NodeInfo_GetTimestampLastChange(ni);
  _addU64t(&ptr, t?((uint64_t)GWEN_Timestamp_toInt64(t)):0L);

  _addU16t(&ptr, AQH_NodeInfo_GetStatsPacketsOut(ni));
  _addU16t(&ptr, AQH_NodeInfo_GetStatsPacketsIn(ni));
  _addU16t(&ptr, AQH_NodeInfo_GetStatsCollisions(ni));
  _addU16t(&ptr, AQH_NodeInfo_GetStatsBusy(ni));
  _addU16t(&ptr, AQH_NodeInfo_GetStatsCrcErrors(ni));
  _addU16t(&ptr, AQH_NodeInfo_GetStatsIoErrors(ni));

  return msg;
}



uint8_t AQH_GetDevicesResponseIpcMsg_GetFlags(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint8At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_FLAGS, 0);
}



uint8_t AQH_GetDevicesResponseIpcMsg_GetBusAddress(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint16At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_BUSADDR, 0);
}



uint32_t AQH_GetDevicesResponseIpcMsg_GetUid(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint32At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_UID, 0);
}



uint32_t AQH_GetDevicesResponseIpcMsg_GetManufacturer(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint32At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_MANUF, 0);
}



uint16_t AQH_GetDevicesResponseIpcMsg_GetDeviceType(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint16At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_DEVTYPE, 0);
}



uint16_t AQH_GetDevicesResponseIpcMsg_GetDeviceVersion(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint16At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_DEVVER, 0);
}



uint32_t AQH_GetDevicesResponseIpcMsg_GetFirmwareVersion(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint32At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_FWVER, 0);
}



int64_t AQH_GetDevicesResponseIpcMsg_GetTimestamp(const GWEN_MSG *msg)
{
  uint64_t v;

  v=(uint64_t) GWEN_Msg_GetUint32At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_LASTCHG, 0);
  v|=((uint64_t)GWEN_Msg_GetUint32At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_LASTCHG+4, 0))<<32;
  return (int64_t) v;
}



uint16_t AQH_GetDevicesResponseIpcMsg_GetPkgOut(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint16At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_PKGOUT, 0);
}



uint16_t AQH_GetDevicesResponseIpcMsg_GetPkgIn(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint16At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_PKGIN, 0);
}



uint16_t AQH_GetDevicesResponseIpcMsg_GetCollisions(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint16At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_COLLISIONS, 0);
}



uint16_t AQH_GetDevicesResponseIpcMsg_GetBusy(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint16At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_BUSY, 0);
}



uint16_t AQH_GetDevicesResponseIpcMsg_GetCrcErrors(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint16At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_CRC, 0);
}



uint16_t AQH_GetDevicesResponseIpcMsg_GetIoErrors(const GWEN_MSG *msg)
{
  return GWEN_Msg_GetUint16At(msg, GWEN_MSGIPC_OFFS_PAYLOAD+AQH_MSGIPC_GETDEVICES_RSP_OFFS_IO, 0);
}



void AQH_GetDevicesResponseIpcMsg_DumpToBuffer(const GWEN_MSG *msg, GWEN_BUFFER *dbuf, const char *sText)
{
  if (GWEN_Msg_GetBytesInBuffer(msg)>=AQH_MSGIPC_GETDEVICES_RSP_MINSIZE) {
    GWEN_Buffer_AppendArgs(dbuf,
                           "GET_DEVICES_RSP %s (code=%d, proto=%d, proto version=%d, uid=0x%08x, bus addr=0x%02x, flags=0x%02x)\n",
                           sText,
                           GWEN_IpcMsg_GetCode(msg),
                           GWEN_IpcMsg_GetProtoId(msg),
                           GWEN_IpcMsg_GetProtoVersion(msg),
                           (unsigned int) AQH_GetDevicesResponseIpcMsg_GetUid(msg),
                           AQH_GetDevicesResponseIpcMsg_GetBusAddress(msg),
                           AQH_GetDevicesResponseIpcMsg_GetFlags(msg));
  }
}



void _addU16t(uint8_t **pPtr, uint16_t i)
{
  uint8_t *ptr=*pPtr;

  *(ptr++)=i & 0xff;
  *(ptr++)=(i>>8) & 0xff;
  *pPtr=ptr;
}



void _addU32t(uint8_t **pPtr, uint32_t i)
{
  uint8_t *ptr=*pPtr;

  *(ptr++)=i & 0xff;
  *(ptr++)=(i>>8) & 0xff;
  *(ptr++)=(i>>16) & 0xff;
  *(ptr++)=(i>>24) & 0xff;
  *pPtr=ptr;
}



void _addU64t(uint8_t **pPtr, uint64_t i)
{
  uint8_t *ptr=*pPtr;

  *(ptr++)=i & 0xff;
  *(ptr++)=(i>>8) & 0xff;
  *(ptr++)=(i>>16) & 0xff;
  *(ptr++)=(i>>24) & 0xff;
  *(ptr++)=(i>>32) & 0xff;
  *(ptr++)=(i>>40) & 0xff;
  *(ptr++)=(i>>48) & 0xff;
  *(ptr++)=(i>>56) & 0xff;
  *pPtr=ptr;
}