mirror of https://github.com/rusefi/bldc.git
183 lines
5.3 KiB
C
183 lines
5.3 KiB
C
/*
|
|
* UAVCAN data structure definition for libcanard.
|
|
*
|
|
* Autogenerated, do not edit.
|
|
*
|
|
* Source file: /Users/jaime/Developer/ardupilot/modules/uavcan/dsdl/uavcan/protocol/file/Path.uavcan
|
|
*/
|
|
#include "uavcan/protocol/file/Path.h"
|
|
#include "canard.h"
|
|
|
|
#ifndef CANARD_INTERNAL_SATURATE
|
|
#define CANARD_INTERNAL_SATURATE(x, max) ( ((x) > max) ? max : ( (-(x) > max) ? (-max) : (x) ) );
|
|
#endif
|
|
|
|
#ifndef CANARD_INTERNAL_SATURATE_UNSIGNED
|
|
#define CANARD_INTERNAL_SATURATE_UNSIGNED(x, max) ( ((x) >= max) ? max : (x) );
|
|
#endif
|
|
|
|
#if defined(__GNUC__)
|
|
# define CANARD_MAYBE_UNUSED(x) x __attribute__((unused))
|
|
#else
|
|
# define CANARD_MAYBE_UNUSED(x) x
|
|
#endif
|
|
|
|
/**
|
|
* @brief uavcan_protocol_file_Path_encode_internal
|
|
* @param source : pointer to source data struct
|
|
* @param msg_buf: pointer to msg storage
|
|
* @param offset: bit offset to msg storage
|
|
* @param root_item: for detecting if TAO should be used
|
|
* @retval returns offset
|
|
*/
|
|
uint32_t uavcan_protocol_file_Path_encode_internal(uavcan_protocol_file_Path* source,
|
|
void* msg_buf,
|
|
uint32_t offset,
|
|
uint8_t CANARD_MAYBE_UNUSED(root_item))
|
|
{
|
|
uint32_t c = 0;
|
|
|
|
// Dynamic Array (path)
|
|
if (! root_item)
|
|
{
|
|
// - Add array length
|
|
canardEncodeScalar(msg_buf, offset, 8, (void*)&source->path.len);
|
|
offset += 8;
|
|
}
|
|
|
|
// - Add array items
|
|
for (c = 0; c < source->path.len; c++)
|
|
{
|
|
canardEncodeScalar(msg_buf,
|
|
offset,
|
|
8,
|
|
(void*)(source->path.data + c));// 255
|
|
offset += 8;
|
|
}
|
|
|
|
return offset;
|
|
}
|
|
|
|
/**
|
|
* @brief uavcan_protocol_file_Path_encode
|
|
* @param source : Pointer to source data struct
|
|
* @param msg_buf: Pointer to msg storage
|
|
* @retval returns message length as bytes
|
|
*/
|
|
uint32_t uavcan_protocol_file_Path_encode(uavcan_protocol_file_Path* source, void* msg_buf)
|
|
{
|
|
uint32_t offset = 0;
|
|
|
|
offset = uavcan_protocol_file_Path_encode_internal(source, msg_buf, offset, 1);
|
|
|
|
return (offset + 7 ) / 8;
|
|
}
|
|
|
|
/**
|
|
* @brief uavcan_protocol_file_Path_decode_internal
|
|
* @param transfer: Pointer to CanardRxTransfer transfer
|
|
* @param payload_len: Payload message length
|
|
* @param dest: Pointer to destination struct
|
|
* @param dyn_arr_buf: NULL or Pointer to memory storage to be used for dynamic arrays
|
|
* uavcan_protocol_file_Path dyn memory will point to dyn_arr_buf memory.
|
|
* NULL will ignore dynamic arrays decoding.
|
|
* @param offset: Call with 0, bit offset to msg storage
|
|
* @retval offset or ERROR value if < 0
|
|
*/
|
|
int32_t uavcan_protocol_file_Path_decode_internal(
|
|
const CanardRxTransfer* transfer,
|
|
uint16_t CANARD_MAYBE_UNUSED(payload_len),
|
|
uavcan_protocol_file_Path* dest,
|
|
uint8_t** CANARD_MAYBE_UNUSED(dyn_arr_buf),
|
|
int32_t offset)
|
|
{
|
|
int32_t ret = 0;
|
|
uint32_t c = 0;
|
|
|
|
// Dynamic Array (path)
|
|
// - Last item in struct & Root item & (Array Size > 8 bit), tail array optimization
|
|
if (payload_len)
|
|
{
|
|
// - Calculate Array length from MSG length
|
|
dest->path.len = ((payload_len * 8) - offset ) / 8; // 8 bit array item size
|
|
}
|
|
else
|
|
{
|
|
// - Array length 8 bits
|
|
ret = canardDecodeScalar(transfer,
|
|
(uint32_t)offset,
|
|
8,
|
|
false,
|
|
(void*)&dest->path.len); // 255
|
|
if (ret != 8)
|
|
{
|
|
goto uavcan_protocol_file_Path_error_exit;
|
|
}
|
|
offset += 8;
|
|
}
|
|
|
|
// - Get Array
|
|
if (dyn_arr_buf)
|
|
{
|
|
dest->path.data = (uint8_t*)*dyn_arr_buf;
|
|
}
|
|
|
|
for (c = 0; c < dest->path.len; c++)
|
|
{
|
|
if (dyn_arr_buf)
|
|
{
|
|
ret = canardDecodeScalar(transfer,
|
|
(uint32_t)offset,
|
|
8,
|
|
false,
|
|
(void*)*dyn_arr_buf); // 255
|
|
if (ret != 8)
|
|
{
|
|
goto uavcan_protocol_file_Path_error_exit;
|
|
}
|
|
*dyn_arr_buf = (uint8_t*)(((uint8_t*)*dyn_arr_buf) + 1);
|
|
}
|
|
offset += 8;
|
|
}
|
|
return offset;
|
|
|
|
uavcan_protocol_file_Path_error_exit:
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
else
|
|
{
|
|
return -CANARD_ERROR_INTERNAL;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief uavcan_protocol_file_Path_decode
|
|
* @param transfer: Pointer to CanardRxTransfer transfer
|
|
* @param payload_len: Payload message length
|
|
* @param dest: Pointer to destination struct
|
|
* @param dyn_arr_buf: NULL or Pointer to memory storage to be used for dynamic arrays
|
|
* uavcan_protocol_file_Path dyn memory will point to dyn_arr_buf memory.
|
|
* NULL will ignore dynamic arrays decoding.
|
|
* @retval offset or ERROR value if < 0
|
|
*/
|
|
int32_t uavcan_protocol_file_Path_decode(const CanardRxTransfer* transfer,
|
|
uint16_t payload_len,
|
|
uavcan_protocol_file_Path* dest,
|
|
uint8_t** dyn_arr_buf)
|
|
{
|
|
const int32_t offset = 0;
|
|
int32_t ret = 0;
|
|
|
|
// Clear the destination struct
|
|
for (uint32_t c = 0; c < sizeof(uavcan_protocol_file_Path); c++)
|
|
{
|
|
((uint8_t*)dest)[c] = 0x00;
|
|
}
|
|
|
|
ret = uavcan_protocol_file_Path_decode_internal(transfer, payload_len, dest, dyn_arr_buf, offset);
|
|
|
|
return ret;
|
|
}
|