packet.c

/***********************************************************************************
 * @file        packet.c                                                           *
 * @brief                                                                          *
 *                                                                                 *
 * @{                                                                              *
 ***********************************************************************************/
 
#include "packet.h"
 
#include "stdbool.h"
#include "string.h"
 
static size_t _Packet_getSize(Packet *packet);
 
/* =============================================================================== */
bool Packet_asBytes(Packet *packet, uint8_t *out, uint8_t size) {
  // Early exit with false if output array size is too small
  if (size < _Packet_getSize(packet))
    return false;
 
  // First byte is always packet identifier
  out[0] = packet->id;
 
  // Iterate through each field, copy data to output array
  for (int i = 0, j = 1; i < packet->length; i++) {
    memcpy(&out[j], packet->fields[i].data, packet->fields[i].size);
    j += packet->fields[i].size;
  }
 
  return true;
}
 
/* =============================================================================== */
static size_t _Packet_getSize(Packet *packet) {
  size_t size = 1;
 
  for (int i = 0; i < packet->length; i++)
    size += packet->fields[i].size;
 
  return size;
}