|
@@ -1,54 +1,60 @@
|
|
|
#pragma once
|
|
|
// MESSAGE VK_DIGI_ESC_STATUS PACKING
|
|
|
|
|
|
-#define MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS 53005
|
|
|
+#define MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS 53008
|
|
|
|
|
|
|
|
|
typedef struct __mavlink_vk_digi_esc_status_t {
|
|
|
- uint32_t time_boot_ms; /*< [ms] Timestamp in ms from system boot.*/
|
|
|
- uint16_t rot_spd; /*< BMS manufactor string*/
|
|
|
- uint8_t model_name[20]; /*< BMS equpment model name string*/
|
|
|
- uint8_t sn_id[20]; /*< BMS SN id string*/
|
|
|
- uint8_t hw_ver[10]; /*< BMS hardware version string*/
|
|
|
- uint8_t fw_ver[10]; /*< BMS firmware version string*/
|
|
|
+ uint32_t timestamp; /*< [ms] Timestamp from system boot.*/
|
|
|
+ int32_t rpm[4]; /*< [rpm] Reported motor RPM from each ESC (negative for
|
|
|
+ reverse rotation).*/
|
|
|
+ float voltage[4]; /*< [V] Voltage measured from each ESC.*/
|
|
|
+ float current[4]; /*< [A] Current measured from each ESC.*/
|
|
|
+ uint32_t status[4]; /*< Status data from each ESC.*/
|
|
|
+ int16_t temperature[4]; /*< [degC] Temperature measured from each ESC.*/
|
|
|
+ uint8_t index; /*< Index of the first ESC in this message.
|
|
|
+ minValue = 0, maxValue = 60, increment = 4.*/
|
|
|
} mavlink_vk_digi_esc_status_t;
|
|
|
|
|
|
-#define MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN 66
|
|
|
-#define MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_MIN_LEN 66
|
|
|
-#define MAVLINK_MSG_ID_53005_LEN 66
|
|
|
-#define MAVLINK_MSG_ID_53005_MIN_LEN 66
|
|
|
+#define MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN 77
|
|
|
+#define MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_MIN_LEN 77
|
|
|
+#define MAVLINK_MSG_ID_53008_LEN 77
|
|
|
+#define MAVLINK_MSG_ID_53008_MIN_LEN 77
|
|
|
|
|
|
-#define MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_CRC 25
|
|
|
-#define MAVLINK_MSG_ID_53005_CRC 25
|
|
|
+#define MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_CRC 110
|
|
|
+#define MAVLINK_MSG_ID_53008_CRC 110
|
|
|
|
|
|
-#define MAVLINK_MSG_VK_DIGI_ESC_STATUS_FIELD_MODEL_NAME_LEN 20
|
|
|
-#define MAVLINK_MSG_VK_DIGI_ESC_STATUS_FIELD_SN_ID_LEN 20
|
|
|
-#define MAVLINK_MSG_VK_DIGI_ESC_STATUS_FIELD_HW_VER_LEN 10
|
|
|
-#define MAVLINK_MSG_VK_DIGI_ESC_STATUS_FIELD_FW_VER_LEN 10
|
|
|
+#define MAVLINK_MSG_VK_DIGI_ESC_STATUS_FIELD_RPM_LEN 4
|
|
|
+#define MAVLINK_MSG_VK_DIGI_ESC_STATUS_FIELD_VOLTAGE_LEN 4
|
|
|
+#define MAVLINK_MSG_VK_DIGI_ESC_STATUS_FIELD_CURRENT_LEN 4
|
|
|
+#define MAVLINK_MSG_VK_DIGI_ESC_STATUS_FIELD_STATUS_LEN 4
|
|
|
+#define MAVLINK_MSG_VK_DIGI_ESC_STATUS_FIELD_TEMPERATURE_LEN 4
|
|
|
|
|
|
#if MAVLINK_COMMAND_24BIT
|
|
|
#define MAVLINK_MESSAGE_INFO_VK_DIGI_ESC_STATUS { \
|
|
|
- 53005, \
|
|
|
+ 53008, \
|
|
|
"VK_DIGI_ESC_STATUS", \
|
|
|
- 6, \
|
|
|
- { { "time_boot_ms", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_vk_digi_esc_status_t, time_boot_ms) }, \
|
|
|
- { "rot_spd", NULL, MAVLINK_TYPE_UINT16_T, 0, 4, offsetof(mavlink_vk_digi_esc_status_t, rot_spd) }, \
|
|
|
- { "model_name", NULL, MAVLINK_TYPE_UINT8_T, 20, 6, offsetof(mavlink_vk_digi_esc_status_t, model_name) }, \
|
|
|
- { "sn_id", NULL, MAVLINK_TYPE_UINT8_T, 20, 26, offsetof(mavlink_vk_digi_esc_status_t, sn_id) }, \
|
|
|
- { "hw_ver", NULL, MAVLINK_TYPE_UINT8_T, 10, 46, offsetof(mavlink_vk_digi_esc_status_t, hw_ver) }, \
|
|
|
- { "fw_ver", NULL, MAVLINK_TYPE_UINT8_T, 10, 56, offsetof(mavlink_vk_digi_esc_status_t, fw_ver) }, \
|
|
|
+ 7, \
|
|
|
+ { { "index", NULL, MAVLINK_TYPE_UINT8_T, 0, 76, offsetof(mavlink_vk_digi_esc_status_t, index) }, \
|
|
|
+ { "timestamp", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_vk_digi_esc_status_t, timestamp) }, \
|
|
|
+ { "rpm", NULL, MAVLINK_TYPE_INT32_T, 4, 4, offsetof(mavlink_vk_digi_esc_status_t, rpm) }, \
|
|
|
+ { "voltage", NULL, MAVLINK_TYPE_FLOAT, 4, 20, offsetof(mavlink_vk_digi_esc_status_t, voltage) }, \
|
|
|
+ { "current", NULL, MAVLINK_TYPE_FLOAT, 4, 36, offsetof(mavlink_vk_digi_esc_status_t, current) }, \
|
|
|
+ { "temperature", NULL, MAVLINK_TYPE_INT16_T, 4, 68, offsetof(mavlink_vk_digi_esc_status_t, temperature) }, \
|
|
|
+ { "status", NULL, MAVLINK_TYPE_UINT32_T, 4, 52, offsetof(mavlink_vk_digi_esc_status_t, status) }, \
|
|
|
} \
|
|
|
}
|
|
|
#else
|
|
|
#define MAVLINK_MESSAGE_INFO_VK_DIGI_ESC_STATUS { \
|
|
|
"VK_DIGI_ESC_STATUS", \
|
|
|
- 6, \
|
|
|
- { { "time_boot_ms", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_vk_digi_esc_status_t, time_boot_ms) }, \
|
|
|
- { "rot_spd", NULL, MAVLINK_TYPE_UINT16_T, 0, 4, offsetof(mavlink_vk_digi_esc_status_t, rot_spd) }, \
|
|
|
- { "model_name", NULL, MAVLINK_TYPE_UINT8_T, 20, 6, offsetof(mavlink_vk_digi_esc_status_t, model_name) }, \
|
|
|
- { "sn_id", NULL, MAVLINK_TYPE_UINT8_T, 20, 26, offsetof(mavlink_vk_digi_esc_status_t, sn_id) }, \
|
|
|
- { "hw_ver", NULL, MAVLINK_TYPE_UINT8_T, 10, 46, offsetof(mavlink_vk_digi_esc_status_t, hw_ver) }, \
|
|
|
- { "fw_ver", NULL, MAVLINK_TYPE_UINT8_T, 10, 56, offsetof(mavlink_vk_digi_esc_status_t, fw_ver) }, \
|
|
|
+ 7, \
|
|
|
+ { { "index", NULL, MAVLINK_TYPE_UINT8_T, 0, 76, offsetof(mavlink_vk_digi_esc_status_t, index) }, \
|
|
|
+ { "timestamp", NULL, MAVLINK_TYPE_UINT32_T, 0, 0, offsetof(mavlink_vk_digi_esc_status_t, timestamp) }, \
|
|
|
+ { "rpm", NULL, MAVLINK_TYPE_INT32_T, 4, 4, offsetof(mavlink_vk_digi_esc_status_t, rpm) }, \
|
|
|
+ { "voltage", NULL, MAVLINK_TYPE_FLOAT, 4, 20, offsetof(mavlink_vk_digi_esc_status_t, voltage) }, \
|
|
|
+ { "current", NULL, MAVLINK_TYPE_FLOAT, 4, 36, offsetof(mavlink_vk_digi_esc_status_t, current) }, \
|
|
|
+ { "temperature", NULL, MAVLINK_TYPE_INT16_T, 4, 68, offsetof(mavlink_vk_digi_esc_status_t, temperature) }, \
|
|
|
+ { "status", NULL, MAVLINK_TYPE_UINT32_T, 4, 52, offsetof(mavlink_vk_digi_esc_status_t, status) }, \
|
|
|
} \
|
|
|
}
|
|
|
#endif
|
|
@@ -59,34 +65,39 @@ typedef struct __mavlink_vk_digi_esc_status_t {
|
|
|
* @param component_id ID of this component (e.g. 200 for IMU)
|
|
|
* @param msg The MAVLink message to compress the data into
|
|
|
*
|
|
|
- * @param time_boot_ms [ms] Timestamp in ms from system boot.
|
|
|
- * @param rot_spd BMS manufactor string
|
|
|
- * @param model_name BMS equpment model name string
|
|
|
- * @param sn_id BMS SN id string
|
|
|
- * @param hw_ver BMS hardware version string
|
|
|
- * @param fw_ver BMS firmware version string
|
|
|
+ * @param index Index of the first ESC in this message.
|
|
|
+ minValue = 0, maxValue = 60, increment = 4.
|
|
|
+ * @param timestamp [ms] Timestamp from system boot.
|
|
|
+ * @param rpm [rpm] Reported motor RPM from each ESC (negative for
|
|
|
+ reverse rotation).
|
|
|
+ * @param voltage [V] Voltage measured from each ESC.
|
|
|
+ * @param current [A] Current measured from each ESC.
|
|
|
+ * @param temperature [degC] Temperature measured from each ESC.
|
|
|
+ * @param status Status data from each ESC.
|
|
|
* @return length of the message in bytes (excluding serial stream start sign)
|
|
|
*/
|
|
|
static inline uint16_t mavlink_msg_vk_digi_esc_status_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg,
|
|
|
- uint32_t time_boot_ms, uint16_t rot_spd, const uint8_t *model_name, const uint8_t *sn_id, const uint8_t *hw_ver, const uint8_t *fw_ver)
|
|
|
+ uint8_t index, uint32_t timestamp, const int32_t *rpm, const float *voltage, const float *current, const int16_t *temperature, const uint32_t *status)
|
|
|
{
|
|
|
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
|
|
|
char buf[MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN];
|
|
|
- _mav_put_uint32_t(buf, 0, time_boot_ms);
|
|
|
- _mav_put_uint16_t(buf, 4, rot_spd);
|
|
|
- _mav_put_uint8_t_array(buf, 6, model_name, 20);
|
|
|
- _mav_put_uint8_t_array(buf, 26, sn_id, 20);
|
|
|
- _mav_put_uint8_t_array(buf, 46, hw_ver, 10);
|
|
|
- _mav_put_uint8_t_array(buf, 56, fw_ver, 10);
|
|
|
+ _mav_put_uint32_t(buf, 0, timestamp);
|
|
|
+ _mav_put_uint8_t(buf, 76, index);
|
|
|
+ _mav_put_int32_t_array(buf, 4, rpm, 4);
|
|
|
+ _mav_put_float_array(buf, 20, voltage, 4);
|
|
|
+ _mav_put_float_array(buf, 36, current, 4);
|
|
|
+ _mav_put_uint32_t_array(buf, 52, status, 4);
|
|
|
+ _mav_put_int16_t_array(buf, 68, temperature, 4);
|
|
|
memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN);
|
|
|
#else
|
|
|
mavlink_vk_digi_esc_status_t packet;
|
|
|
- packet.time_boot_ms = time_boot_ms;
|
|
|
- packet.rot_spd = rot_spd;
|
|
|
- mav_array_memcpy(packet.model_name, model_name, sizeof(uint8_t)*20);
|
|
|
- mav_array_memcpy(packet.sn_id, sn_id, sizeof(uint8_t)*20);
|
|
|
- mav_array_memcpy(packet.hw_ver, hw_ver, sizeof(uint8_t)*10);
|
|
|
- mav_array_memcpy(packet.fw_ver, fw_ver, sizeof(uint8_t)*10);
|
|
|
+ packet.timestamp = timestamp;
|
|
|
+ packet.index = index;
|
|
|
+ mav_array_memcpy(packet.rpm, rpm, sizeof(int32_t)*4);
|
|
|
+ mav_array_memcpy(packet.voltage, voltage, sizeof(float)*4);
|
|
|
+ mav_array_memcpy(packet.current, current, sizeof(float)*4);
|
|
|
+ mav_array_memcpy(packet.status, status, sizeof(uint32_t)*4);
|
|
|
+ mav_array_memcpy(packet.temperature, temperature, sizeof(int16_t)*4);
|
|
|
memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN);
|
|
|
#endif
|
|
|
|
|
@@ -101,34 +112,39 @@ static inline uint16_t mavlink_msg_vk_digi_esc_status_pack(uint8_t system_id, ui
|
|
|
* @param status MAVLink status structure
|
|
|
* @param msg The MAVLink message to compress the data into
|
|
|
*
|
|
|
- * @param time_boot_ms [ms] Timestamp in ms from system boot.
|
|
|
- * @param rot_spd BMS manufactor string
|
|
|
- * @param model_name BMS equpment model name string
|
|
|
- * @param sn_id BMS SN id string
|
|
|
- * @param hw_ver BMS hardware version string
|
|
|
- * @param fw_ver BMS firmware version string
|
|
|
+ * @param index Index of the first ESC in this message.
|
|
|
+ minValue = 0, maxValue = 60, increment = 4.
|
|
|
+ * @param timestamp [ms] Timestamp from system boot.
|
|
|
+ * @param rpm [rpm] Reported motor RPM from each ESC (negative for
|
|
|
+ reverse rotation).
|
|
|
+ * @param voltage [V] Voltage measured from each ESC.
|
|
|
+ * @param current [A] Current measured from each ESC.
|
|
|
+ * @param temperature [degC] Temperature measured from each ESC.
|
|
|
+ * @param status Status data from each ESC.
|
|
|
* @return length of the message in bytes (excluding serial stream start sign)
|
|
|
*/
|
|
|
static inline uint16_t mavlink_msg_vk_digi_esc_status_pack_status(uint8_t system_id, uint8_t component_id, mavlink_status_t *_status, mavlink_message_t* msg,
|
|
|
- uint32_t time_boot_ms, uint16_t rot_spd, const uint8_t *model_name, const uint8_t *sn_id, const uint8_t *hw_ver, const uint8_t *fw_ver)
|
|
|
+ uint8_t index, uint32_t timestamp, const int32_t *rpm, const float *voltage, const float *current, const int16_t *temperature, const uint32_t *status)
|
|
|
{
|
|
|
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
|
|
|
char buf[MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN];
|
|
|
- _mav_put_uint32_t(buf, 0, time_boot_ms);
|
|
|
- _mav_put_uint16_t(buf, 4, rot_spd);
|
|
|
- _mav_put_uint8_t_array(buf, 6, model_name, 20);
|
|
|
- _mav_put_uint8_t_array(buf, 26, sn_id, 20);
|
|
|
- _mav_put_uint8_t_array(buf, 46, hw_ver, 10);
|
|
|
- _mav_put_uint8_t_array(buf, 56, fw_ver, 10);
|
|
|
+ _mav_put_uint32_t(buf, 0, timestamp);
|
|
|
+ _mav_put_uint8_t(buf, 76, index);
|
|
|
+ _mav_put_int32_t_array(buf, 4, rpm, 4);
|
|
|
+ _mav_put_float_array(buf, 20, voltage, 4);
|
|
|
+ _mav_put_float_array(buf, 36, current, 4);
|
|
|
+ _mav_put_uint32_t_array(buf, 52, status, 4);
|
|
|
+ _mav_put_int16_t_array(buf, 68, temperature, 4);
|
|
|
memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN);
|
|
|
#else
|
|
|
mavlink_vk_digi_esc_status_t packet;
|
|
|
- packet.time_boot_ms = time_boot_ms;
|
|
|
- packet.rot_spd = rot_spd;
|
|
|
- mav_array_memcpy(packet.model_name, model_name, sizeof(uint8_t)*20);
|
|
|
- mav_array_memcpy(packet.sn_id, sn_id, sizeof(uint8_t)*20);
|
|
|
- mav_array_memcpy(packet.hw_ver, hw_ver, sizeof(uint8_t)*10);
|
|
|
- mav_array_memcpy(packet.fw_ver, fw_ver, sizeof(uint8_t)*10);
|
|
|
+ packet.timestamp = timestamp;
|
|
|
+ packet.index = index;
|
|
|
+ mav_array_memcpy(packet.rpm, rpm, sizeof(int32_t)*4);
|
|
|
+ mav_array_memcpy(packet.voltage, voltage, sizeof(float)*4);
|
|
|
+ mav_array_memcpy(packet.current, current, sizeof(float)*4);
|
|
|
+ mav_array_memcpy(packet.status, status, sizeof(uint32_t)*4);
|
|
|
+ mav_array_memcpy(packet.temperature, temperature, sizeof(int16_t)*4);
|
|
|
memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN);
|
|
|
#endif
|
|
|
|
|
@@ -146,35 +162,40 @@ static inline uint16_t mavlink_msg_vk_digi_esc_status_pack_status(uint8_t system
|
|
|
* @param component_id ID of this component (e.g. 200 for IMU)
|
|
|
* @param chan The MAVLink channel this message will be sent over
|
|
|
* @param msg The MAVLink message to compress the data into
|
|
|
- * @param time_boot_ms [ms] Timestamp in ms from system boot.
|
|
|
- * @param rot_spd BMS manufactor string
|
|
|
- * @param model_name BMS equpment model name string
|
|
|
- * @param sn_id BMS SN id string
|
|
|
- * @param hw_ver BMS hardware version string
|
|
|
- * @param fw_ver BMS firmware version string
|
|
|
+ * @param index Index of the first ESC in this message.
|
|
|
+ minValue = 0, maxValue = 60, increment = 4.
|
|
|
+ * @param timestamp [ms] Timestamp from system boot.
|
|
|
+ * @param rpm [rpm] Reported motor RPM from each ESC (negative for
|
|
|
+ reverse rotation).
|
|
|
+ * @param voltage [V] Voltage measured from each ESC.
|
|
|
+ * @param current [A] Current measured from each ESC.
|
|
|
+ * @param temperature [degC] Temperature measured from each ESC.
|
|
|
+ * @param status Status data from each ESC.
|
|
|
* @return length of the message in bytes (excluding serial stream start sign)
|
|
|
*/
|
|
|
static inline uint16_t mavlink_msg_vk_digi_esc_status_pack_chan(uint8_t system_id, uint8_t component_id, uint8_t chan,
|
|
|
mavlink_message_t* msg,
|
|
|
- uint32_t time_boot_ms,uint16_t rot_spd,const uint8_t *model_name,const uint8_t *sn_id,const uint8_t *hw_ver,const uint8_t *fw_ver)
|
|
|
+ uint8_t index,uint32_t timestamp,const int32_t *rpm,const float *voltage,const float *current,const int16_t *temperature,const uint32_t *status)
|
|
|
{
|
|
|
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
|
|
|
char buf[MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN];
|
|
|
- _mav_put_uint32_t(buf, 0, time_boot_ms);
|
|
|
- _mav_put_uint16_t(buf, 4, rot_spd);
|
|
|
- _mav_put_uint8_t_array(buf, 6, model_name, 20);
|
|
|
- _mav_put_uint8_t_array(buf, 26, sn_id, 20);
|
|
|
- _mav_put_uint8_t_array(buf, 46, hw_ver, 10);
|
|
|
- _mav_put_uint8_t_array(buf, 56, fw_ver, 10);
|
|
|
+ _mav_put_uint32_t(buf, 0, timestamp);
|
|
|
+ _mav_put_uint8_t(buf, 76, index);
|
|
|
+ _mav_put_int32_t_array(buf, 4, rpm, 4);
|
|
|
+ _mav_put_float_array(buf, 20, voltage, 4);
|
|
|
+ _mav_put_float_array(buf, 36, current, 4);
|
|
|
+ _mav_put_uint32_t_array(buf, 52, status, 4);
|
|
|
+ _mav_put_int16_t_array(buf, 68, temperature, 4);
|
|
|
memcpy(_MAV_PAYLOAD_NON_CONST(msg), buf, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN);
|
|
|
#else
|
|
|
mavlink_vk_digi_esc_status_t packet;
|
|
|
- packet.time_boot_ms = time_boot_ms;
|
|
|
- packet.rot_spd = rot_spd;
|
|
|
- mav_array_memcpy(packet.model_name, model_name, sizeof(uint8_t)*20);
|
|
|
- mav_array_memcpy(packet.sn_id, sn_id, sizeof(uint8_t)*20);
|
|
|
- mav_array_memcpy(packet.hw_ver, hw_ver, sizeof(uint8_t)*10);
|
|
|
- mav_array_memcpy(packet.fw_ver, fw_ver, sizeof(uint8_t)*10);
|
|
|
+ packet.timestamp = timestamp;
|
|
|
+ packet.index = index;
|
|
|
+ mav_array_memcpy(packet.rpm, rpm, sizeof(int32_t)*4);
|
|
|
+ mav_array_memcpy(packet.voltage, voltage, sizeof(float)*4);
|
|
|
+ mav_array_memcpy(packet.current, current, sizeof(float)*4);
|
|
|
+ mav_array_memcpy(packet.status, status, sizeof(uint32_t)*4);
|
|
|
+ mav_array_memcpy(packet.temperature, temperature, sizeof(int16_t)*4);
|
|
|
memcpy(_MAV_PAYLOAD_NON_CONST(msg), &packet, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN);
|
|
|
#endif
|
|
|
|
|
@@ -192,7 +213,7 @@ static inline uint16_t mavlink_msg_vk_digi_esc_status_pack_chan(uint8_t system_i
|
|
|
*/
|
|
|
static inline uint16_t mavlink_msg_vk_digi_esc_status_encode(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, const mavlink_vk_digi_esc_status_t* vk_digi_esc_status)
|
|
|
{
|
|
|
- return mavlink_msg_vk_digi_esc_status_pack(system_id, component_id, msg, vk_digi_esc_status->time_boot_ms, vk_digi_esc_status->rot_spd, vk_digi_esc_status->model_name, vk_digi_esc_status->sn_id, vk_digi_esc_status->hw_ver, vk_digi_esc_status->fw_ver);
|
|
|
+ return mavlink_msg_vk_digi_esc_status_pack(system_id, component_id, msg, vk_digi_esc_status->index, vk_digi_esc_status->timestamp, vk_digi_esc_status->rpm, vk_digi_esc_status->voltage, vk_digi_esc_status->current, vk_digi_esc_status->temperature, vk_digi_esc_status->status);
|
|
|
}
|
|
|
|
|
|
/**
|
|
@@ -206,7 +227,7 @@ static inline uint16_t mavlink_msg_vk_digi_esc_status_encode(uint8_t system_id,
|
|
|
*/
|
|
|
static inline uint16_t mavlink_msg_vk_digi_esc_status_encode_chan(uint8_t system_id, uint8_t component_id, uint8_t chan, mavlink_message_t* msg, const mavlink_vk_digi_esc_status_t* vk_digi_esc_status)
|
|
|
{
|
|
|
- return mavlink_msg_vk_digi_esc_status_pack_chan(system_id, component_id, chan, msg, vk_digi_esc_status->time_boot_ms, vk_digi_esc_status->rot_spd, vk_digi_esc_status->model_name, vk_digi_esc_status->sn_id, vk_digi_esc_status->hw_ver, vk_digi_esc_status->fw_ver);
|
|
|
+ return mavlink_msg_vk_digi_esc_status_pack_chan(system_id, component_id, chan, msg, vk_digi_esc_status->index, vk_digi_esc_status->timestamp, vk_digi_esc_status->rpm, vk_digi_esc_status->voltage, vk_digi_esc_status->current, vk_digi_esc_status->temperature, vk_digi_esc_status->status);
|
|
|
}
|
|
|
|
|
|
/**
|
|
@@ -220,41 +241,46 @@ static inline uint16_t mavlink_msg_vk_digi_esc_status_encode_chan(uint8_t system
|
|
|
*/
|
|
|
static inline uint16_t mavlink_msg_vk_digi_esc_status_encode_status(uint8_t system_id, uint8_t component_id, mavlink_status_t* _status, mavlink_message_t* msg, const mavlink_vk_digi_esc_status_t* vk_digi_esc_status)
|
|
|
{
|
|
|
- return mavlink_msg_vk_digi_esc_status_pack_status(system_id, component_id, _status, msg, vk_digi_esc_status->time_boot_ms, vk_digi_esc_status->rot_spd, vk_digi_esc_status->model_name, vk_digi_esc_status->sn_id, vk_digi_esc_status->hw_ver, vk_digi_esc_status->fw_ver);
|
|
|
+ return mavlink_msg_vk_digi_esc_status_pack_status(system_id, component_id, _status, msg, vk_digi_esc_status->index, vk_digi_esc_status->timestamp, vk_digi_esc_status->rpm, vk_digi_esc_status->voltage, vk_digi_esc_status->current, vk_digi_esc_status->temperature, vk_digi_esc_status->status);
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
* @brief Send a vk_digi_esc_status message
|
|
|
* @param chan MAVLink channel to send the message
|
|
|
*
|
|
|
- * @param time_boot_ms [ms] Timestamp in ms from system boot.
|
|
|
- * @param rot_spd BMS manufactor string
|
|
|
- * @param model_name BMS equpment model name string
|
|
|
- * @param sn_id BMS SN id string
|
|
|
- * @param hw_ver BMS hardware version string
|
|
|
- * @param fw_ver BMS firmware version string
|
|
|
+ * @param index Index of the first ESC in this message.
|
|
|
+ minValue = 0, maxValue = 60, increment = 4.
|
|
|
+ * @param timestamp [ms] Timestamp from system boot.
|
|
|
+ * @param rpm [rpm] Reported motor RPM from each ESC (negative for
|
|
|
+ reverse rotation).
|
|
|
+ * @param voltage [V] Voltage measured from each ESC.
|
|
|
+ * @param current [A] Current measured from each ESC.
|
|
|
+ * @param temperature [degC] Temperature measured from each ESC.
|
|
|
+ * @param status Status data from each ESC.
|
|
|
*/
|
|
|
#ifdef MAVLINK_USE_CONVENIENCE_FUNCTIONS
|
|
|
|
|
|
-static inline void mavlink_msg_vk_digi_esc_status_send(mavlink_channel_t chan, uint32_t time_boot_ms, uint16_t rot_spd, const uint8_t *model_name, const uint8_t *sn_id, const uint8_t *hw_ver, const uint8_t *fw_ver)
|
|
|
+static inline void mavlink_msg_vk_digi_esc_status_send(mavlink_channel_t chan, uint8_t index, uint32_t timestamp, const int32_t *rpm, const float *voltage, const float *current, const int16_t *temperature, const uint32_t *status)
|
|
|
{
|
|
|
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
|
|
|
char buf[MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN];
|
|
|
- _mav_put_uint32_t(buf, 0, time_boot_ms);
|
|
|
- _mav_put_uint16_t(buf, 4, rot_spd);
|
|
|
- _mav_put_uint8_t_array(buf, 6, model_name, 20);
|
|
|
- _mav_put_uint8_t_array(buf, 26, sn_id, 20);
|
|
|
- _mav_put_uint8_t_array(buf, 46, hw_ver, 10);
|
|
|
- _mav_put_uint8_t_array(buf, 56, fw_ver, 10);
|
|
|
+ _mav_put_uint32_t(buf, 0, timestamp);
|
|
|
+ _mav_put_uint8_t(buf, 76, index);
|
|
|
+ _mav_put_int32_t_array(buf, 4, rpm, 4);
|
|
|
+ _mav_put_float_array(buf, 20, voltage, 4);
|
|
|
+ _mav_put_float_array(buf, 36, current, 4);
|
|
|
+ _mav_put_uint32_t_array(buf, 52, status, 4);
|
|
|
+ _mav_put_int16_t_array(buf, 68, temperature, 4);
|
|
|
_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS, buf, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_MIN_LEN, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_CRC);
|
|
|
#else
|
|
|
mavlink_vk_digi_esc_status_t packet;
|
|
|
- packet.time_boot_ms = time_boot_ms;
|
|
|
- packet.rot_spd = rot_spd;
|
|
|
- mav_array_memcpy(packet.model_name, model_name, sizeof(uint8_t)*20);
|
|
|
- mav_array_memcpy(packet.sn_id, sn_id, sizeof(uint8_t)*20);
|
|
|
- mav_array_memcpy(packet.hw_ver, hw_ver, sizeof(uint8_t)*10);
|
|
|
- mav_array_memcpy(packet.fw_ver, fw_ver, sizeof(uint8_t)*10);
|
|
|
+ packet.timestamp = timestamp;
|
|
|
+ packet.index = index;
|
|
|
+ mav_array_memcpy(packet.rpm, rpm, sizeof(int32_t)*4);
|
|
|
+ mav_array_memcpy(packet.voltage, voltage, sizeof(float)*4);
|
|
|
+ mav_array_memcpy(packet.current, current, sizeof(float)*4);
|
|
|
+ mav_array_memcpy(packet.status, status, sizeof(uint32_t)*4);
|
|
|
+ mav_array_memcpy(packet.temperature, temperature, sizeof(int16_t)*4);
|
|
|
_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS, (const char *)&packet, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_MIN_LEN, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_CRC);
|
|
|
#endif
|
|
|
}
|
|
@@ -267,7 +293,7 @@ static inline void mavlink_msg_vk_digi_esc_status_send(mavlink_channel_t chan, u
|
|
|
static inline void mavlink_msg_vk_digi_esc_status_send_struct(mavlink_channel_t chan, const mavlink_vk_digi_esc_status_t* vk_digi_esc_status)
|
|
|
{
|
|
|
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
|
|
|
- mavlink_msg_vk_digi_esc_status_send(chan, vk_digi_esc_status->time_boot_ms, vk_digi_esc_status->rot_spd, vk_digi_esc_status->model_name, vk_digi_esc_status->sn_id, vk_digi_esc_status->hw_ver, vk_digi_esc_status->fw_ver);
|
|
|
+ mavlink_msg_vk_digi_esc_status_send(chan, vk_digi_esc_status->index, vk_digi_esc_status->timestamp, vk_digi_esc_status->rpm, vk_digi_esc_status->voltage, vk_digi_esc_status->current, vk_digi_esc_status->temperature, vk_digi_esc_status->status);
|
|
|
#else
|
|
|
_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS, (const char *)vk_digi_esc_status, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_MIN_LEN, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_CRC);
|
|
|
#endif
|
|
@@ -281,25 +307,27 @@ static inline void mavlink_msg_vk_digi_esc_status_send_struct(mavlink_channel_t
|
|
|
is usually the receive buffer for the channel, and allows a reply to an
|
|
|
incoming message with minimum stack space usage.
|
|
|
*/
|
|
|
-static inline void mavlink_msg_vk_digi_esc_status_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, uint32_t time_boot_ms, uint16_t rot_spd, const uint8_t *model_name, const uint8_t *sn_id, const uint8_t *hw_ver, const uint8_t *fw_ver)
|
|
|
+static inline void mavlink_msg_vk_digi_esc_status_send_buf(mavlink_message_t *msgbuf, mavlink_channel_t chan, uint8_t index, uint32_t timestamp, const int32_t *rpm, const float *voltage, const float *current, const int16_t *temperature, const uint32_t *status)
|
|
|
{
|
|
|
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
|
|
|
char *buf = (char *)msgbuf;
|
|
|
- _mav_put_uint32_t(buf, 0, time_boot_ms);
|
|
|
- _mav_put_uint16_t(buf, 4, rot_spd);
|
|
|
- _mav_put_uint8_t_array(buf, 6, model_name, 20);
|
|
|
- _mav_put_uint8_t_array(buf, 26, sn_id, 20);
|
|
|
- _mav_put_uint8_t_array(buf, 46, hw_ver, 10);
|
|
|
- _mav_put_uint8_t_array(buf, 56, fw_ver, 10);
|
|
|
+ _mav_put_uint32_t(buf, 0, timestamp);
|
|
|
+ _mav_put_uint8_t(buf, 76, index);
|
|
|
+ _mav_put_int32_t_array(buf, 4, rpm, 4);
|
|
|
+ _mav_put_float_array(buf, 20, voltage, 4);
|
|
|
+ _mav_put_float_array(buf, 36, current, 4);
|
|
|
+ _mav_put_uint32_t_array(buf, 52, status, 4);
|
|
|
+ _mav_put_int16_t_array(buf, 68, temperature, 4);
|
|
|
_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS, buf, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_MIN_LEN, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_CRC);
|
|
|
#else
|
|
|
mavlink_vk_digi_esc_status_t *packet = (mavlink_vk_digi_esc_status_t *)msgbuf;
|
|
|
- packet->time_boot_ms = time_boot_ms;
|
|
|
- packet->rot_spd = rot_spd;
|
|
|
- mav_array_memcpy(packet->model_name, model_name, sizeof(uint8_t)*20);
|
|
|
- mav_array_memcpy(packet->sn_id, sn_id, sizeof(uint8_t)*20);
|
|
|
- mav_array_memcpy(packet->hw_ver, hw_ver, sizeof(uint8_t)*10);
|
|
|
- mav_array_memcpy(packet->fw_ver, fw_ver, sizeof(uint8_t)*10);
|
|
|
+ packet->timestamp = timestamp;
|
|
|
+ packet->index = index;
|
|
|
+ mav_array_memcpy(packet->rpm, rpm, sizeof(int32_t)*4);
|
|
|
+ mav_array_memcpy(packet->voltage, voltage, sizeof(float)*4);
|
|
|
+ mav_array_memcpy(packet->current, current, sizeof(float)*4);
|
|
|
+ mav_array_memcpy(packet->status, status, sizeof(uint32_t)*4);
|
|
|
+ mav_array_memcpy(packet->temperature, temperature, sizeof(int16_t)*4);
|
|
|
_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS, (const char *)packet, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_MIN_LEN, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_CRC);
|
|
|
#endif
|
|
|
}
|
|
@@ -311,63 +339,75 @@ static inline void mavlink_msg_vk_digi_esc_status_send_buf(mavlink_message_t *ms
|
|
|
|
|
|
|
|
|
/**
|
|
|
- * @brief Get field time_boot_ms from vk_digi_esc_status message
|
|
|
+ * @brief Get field index from vk_digi_esc_status message
|
|
|
*
|
|
|
- * @return [ms] Timestamp in ms from system boot.
|
|
|
+ * @return Index of the first ESC in this message.
|
|
|
+ minValue = 0, maxValue = 60, increment = 4.
|
|
|
*/
|
|
|
-static inline uint32_t mavlink_msg_vk_digi_esc_status_get_time_boot_ms(const mavlink_message_t* msg)
|
|
|
+static inline uint8_t mavlink_msg_vk_digi_esc_status_get_index(const mavlink_message_t* msg)
|
|
|
+{
|
|
|
+ return _MAV_RETURN_uint8_t(msg, 76);
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * @brief Get field timestamp from vk_digi_esc_status message
|
|
|
+ *
|
|
|
+ * @return [ms] Timestamp from system boot.
|
|
|
+ */
|
|
|
+static inline uint32_t mavlink_msg_vk_digi_esc_status_get_timestamp(const mavlink_message_t* msg)
|
|
|
{
|
|
|
return _MAV_RETURN_uint32_t(msg, 0);
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * @brief Get field rot_spd from vk_digi_esc_status message
|
|
|
+ * @brief Get field rpm from vk_digi_esc_status message
|
|
|
*
|
|
|
- * @return BMS manufactor string
|
|
|
+ * @return [rpm] Reported motor RPM from each ESC (negative for
|
|
|
+ reverse rotation).
|
|
|
*/
|
|
|
-static inline uint16_t mavlink_msg_vk_digi_esc_status_get_rot_spd(const mavlink_message_t* msg)
|
|
|
+static inline uint16_t mavlink_msg_vk_digi_esc_status_get_rpm(const mavlink_message_t* msg, int32_t *rpm)
|
|
|
{
|
|
|
- return _MAV_RETURN_uint16_t(msg, 4);
|
|
|
+ return _MAV_RETURN_int32_t_array(msg, rpm, 4, 4);
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * @brief Get field model_name from vk_digi_esc_status message
|
|
|
+ * @brief Get field voltage from vk_digi_esc_status message
|
|
|
*
|
|
|
- * @return BMS equpment model name string
|
|
|
+ * @return [V] Voltage measured from each ESC.
|
|
|
*/
|
|
|
-static inline uint16_t mavlink_msg_vk_digi_esc_status_get_model_name(const mavlink_message_t* msg, uint8_t *model_name)
|
|
|
+static inline uint16_t mavlink_msg_vk_digi_esc_status_get_voltage(const mavlink_message_t* msg, float *voltage)
|
|
|
{
|
|
|
- return _MAV_RETURN_uint8_t_array(msg, model_name, 20, 6);
|
|
|
+ return _MAV_RETURN_float_array(msg, voltage, 4, 20);
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * @brief Get field sn_id from vk_digi_esc_status message
|
|
|
+ * @brief Get field current from vk_digi_esc_status message
|
|
|
*
|
|
|
- * @return BMS SN id string
|
|
|
+ * @return [A] Current measured from each ESC.
|
|
|
*/
|
|
|
-static inline uint16_t mavlink_msg_vk_digi_esc_status_get_sn_id(const mavlink_message_t* msg, uint8_t *sn_id)
|
|
|
+static inline uint16_t mavlink_msg_vk_digi_esc_status_get_current(const mavlink_message_t* msg, float *current)
|
|
|
{
|
|
|
- return _MAV_RETURN_uint8_t_array(msg, sn_id, 20, 26);
|
|
|
+ return _MAV_RETURN_float_array(msg, current, 4, 36);
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * @brief Get field hw_ver from vk_digi_esc_status message
|
|
|
+ * @brief Get field temperature from vk_digi_esc_status message
|
|
|
*
|
|
|
- * @return BMS hardware version string
|
|
|
+ * @return [degC] Temperature measured from each ESC.
|
|
|
*/
|
|
|
-static inline uint16_t mavlink_msg_vk_digi_esc_status_get_hw_ver(const mavlink_message_t* msg, uint8_t *hw_ver)
|
|
|
+static inline uint16_t mavlink_msg_vk_digi_esc_status_get_temperature(const mavlink_message_t* msg, int16_t *temperature)
|
|
|
{
|
|
|
- return _MAV_RETURN_uint8_t_array(msg, hw_ver, 10, 46);
|
|
|
+ return _MAV_RETURN_int16_t_array(msg, temperature, 4, 68);
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * @brief Get field fw_ver from vk_digi_esc_status message
|
|
|
+ * @brief Get field status from vk_digi_esc_status message
|
|
|
*
|
|
|
- * @return BMS firmware version string
|
|
|
+ * @return Status data from each ESC.
|
|
|
*/
|
|
|
-static inline uint16_t mavlink_msg_vk_digi_esc_status_get_fw_ver(const mavlink_message_t* msg, uint8_t *fw_ver)
|
|
|
+static inline uint16_t mavlink_msg_vk_digi_esc_status_get_status(const mavlink_message_t* msg, uint32_t *status)
|
|
|
{
|
|
|
- return _MAV_RETURN_uint8_t_array(msg, fw_ver, 10, 56);
|
|
|
+ return _MAV_RETURN_uint32_t_array(msg, status, 4, 52);
|
|
|
}
|
|
|
|
|
|
/**
|
|
@@ -379,12 +419,13 @@ static inline uint16_t mavlink_msg_vk_digi_esc_status_get_fw_ver(const mavlink_m
|
|
|
static inline void mavlink_msg_vk_digi_esc_status_decode(const mavlink_message_t* msg, mavlink_vk_digi_esc_status_t* vk_digi_esc_status)
|
|
|
{
|
|
|
#if MAVLINK_NEED_BYTE_SWAP || !MAVLINK_ALIGNED_FIELDS
|
|
|
- vk_digi_esc_status->time_boot_ms = mavlink_msg_vk_digi_esc_status_get_time_boot_ms(msg);
|
|
|
- vk_digi_esc_status->rot_spd = mavlink_msg_vk_digi_esc_status_get_rot_spd(msg);
|
|
|
- mavlink_msg_vk_digi_esc_status_get_model_name(msg, vk_digi_esc_status->model_name);
|
|
|
- mavlink_msg_vk_digi_esc_status_get_sn_id(msg, vk_digi_esc_status->sn_id);
|
|
|
- mavlink_msg_vk_digi_esc_status_get_hw_ver(msg, vk_digi_esc_status->hw_ver);
|
|
|
- mavlink_msg_vk_digi_esc_status_get_fw_ver(msg, vk_digi_esc_status->fw_ver);
|
|
|
+ vk_digi_esc_status->timestamp = mavlink_msg_vk_digi_esc_status_get_timestamp(msg);
|
|
|
+ mavlink_msg_vk_digi_esc_status_get_rpm(msg, vk_digi_esc_status->rpm);
|
|
|
+ mavlink_msg_vk_digi_esc_status_get_voltage(msg, vk_digi_esc_status->voltage);
|
|
|
+ mavlink_msg_vk_digi_esc_status_get_current(msg, vk_digi_esc_status->current);
|
|
|
+ mavlink_msg_vk_digi_esc_status_get_status(msg, vk_digi_esc_status->status);
|
|
|
+ mavlink_msg_vk_digi_esc_status_get_temperature(msg, vk_digi_esc_status->temperature);
|
|
|
+ vk_digi_esc_status->index = mavlink_msg_vk_digi_esc_status_get_index(msg);
|
|
|
#else
|
|
|
uint8_t len = msg->len < MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN? msg->len : MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN;
|
|
|
memset(vk_digi_esc_status, 0, MAVLINK_MSG_ID_VK_DIGI_ESC_STATUS_LEN);
|