【类 型】:style
【原 因】: 【过 程】: 【影 响】:
This commit is contained in:
parent
d713db3c1d
commit
ceba245d46
@ -75,7 +75,6 @@ MAVLINK_HELPER uint16_t mavlink_finalize_message_chan(mavlink_message_t* msg, ui
|
|||||||
return length + MAVLINK_NUM_NON_PAYLOAD_BYTES;
|
return length + MAVLINK_NUM_NON_PAYLOAD_BYTES;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Finalize a MAVLink message with MAVLINK_COMM_0 as default channel
|
* @brief Finalize a MAVLink message with MAVLINK_COMM_0 as default channel
|
||||||
*/
|
*/
|
||||||
@ -161,7 +160,8 @@ MAVLINK_HELPER uint16_t mavlink_msg_to_send_buffer(uint8_t *buffer, const mavlin
|
|||||||
return MAVLINK_NUM_NON_PAYLOAD_BYTES + (uint16_t)msg->len;
|
return MAVLINK_NUM_NON_PAYLOAD_BYTES + (uint16_t)msg->len;
|
||||||
}
|
}
|
||||||
|
|
||||||
union __mavlink_bitfield {
|
union __mavlink_bitfield
|
||||||
|
{
|
||||||
uint8_t uint8;
|
uint8_t uint8;
|
||||||
int8_t int8;
|
int8_t int8;
|
||||||
uint16_t uint16;
|
uint16_t uint16;
|
||||||
@ -170,7 +170,6 @@ union __mavlink_bitfield {
|
|||||||
int32_t int32;
|
int32_t int32;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
MAVLINK_HELPER void mavlink_start_checksum(mavlink_message_t *msg)
|
MAVLINK_HELPER void mavlink_start_checksum(mavlink_message_t *msg)
|
||||||
{
|
{
|
||||||
crc_init(&msg->checksum);
|
crc_init(&msg->checksum);
|
||||||
@ -305,7 +304,8 @@ MAVLINK_HELPER uint8_t mavlink_parse_char(uint8_t chan, uint8_t c, mavlink_messa
|
|||||||
break;
|
break;
|
||||||
|
|
||||||
case MAVLINK_PARSE_STATE_GOT_MSGID:
|
case MAVLINK_PARSE_STATE_GOT_MSGID:
|
||||||
_MAV_PAYLOAD_NON_CONST(rxmsg)[status->packet_idx++] = (char)c;
|
_MAV_PAYLOAD_NON_CONST(rxmsg)
|
||||||
|
[status->packet_idx++] = (char)c;
|
||||||
mavlink_update_checksum(rxmsg, c);
|
mavlink_update_checksum(rxmsg, c);
|
||||||
if (status->packet_idx == rxmsg->len)
|
if (status->packet_idx == rxmsg->len)
|
||||||
{
|
{
|
||||||
@ -317,7 +317,8 @@ MAVLINK_HELPER uint8_t mavlink_parse_char(uint8_t chan, uint8_t c, mavlink_messa
|
|||||||
#if MAVLINK_CRC_EXTRA
|
#if MAVLINK_CRC_EXTRA
|
||||||
mavlink_update_checksum(rxmsg, MAVLINK_MESSAGE_CRC(rxmsg->msgid));
|
mavlink_update_checksum(rxmsg, MAVLINK_MESSAGE_CRC(rxmsg->msgid));
|
||||||
#endif
|
#endif
|
||||||
if (c != (rxmsg->checksum & 0xFF)) {
|
if (c != (rxmsg->checksum & 0xFF))
|
||||||
|
{
|
||||||
// Check first checksum byte
|
// Check first checksum byte
|
||||||
status->parse_error++;
|
status->parse_error++;
|
||||||
status->msg_received = 0;
|
status->msg_received = 0;
|
||||||
@ -332,12 +333,14 @@ MAVLINK_HELPER uint8_t mavlink_parse_char(uint8_t chan, uint8_t c, mavlink_messa
|
|||||||
else
|
else
|
||||||
{
|
{
|
||||||
status->parse_state = MAVLINK_PARSE_STATE_GOT_CRC1;
|
status->parse_state = MAVLINK_PARSE_STATE_GOT_CRC1;
|
||||||
_MAV_PAYLOAD_NON_CONST(rxmsg)[status->packet_idx] = (char)c;
|
_MAV_PAYLOAD_NON_CONST(rxmsg)
|
||||||
|
[status->packet_idx] = (char)c;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case MAVLINK_PARSE_STATE_GOT_CRC1:
|
case MAVLINK_PARSE_STATE_GOT_CRC1:
|
||||||
if (c != (rxmsg->checksum >> 8)) {
|
if (c != (rxmsg->checksum >> 8))
|
||||||
|
{
|
||||||
// Check second checksum byte
|
// Check second checksum byte
|
||||||
status->parse_error++;
|
status->parse_error++;
|
||||||
status->msg_received = 0;
|
status->msg_received = 0;
|
||||||
@ -354,7 +357,8 @@ MAVLINK_HELPER uint8_t mavlink_parse_char(uint8_t chan, uint8_t c, mavlink_messa
|
|||||||
// Successfully got message
|
// Successfully got message
|
||||||
status->msg_received = 1;
|
status->msg_received = 1;
|
||||||
status->parse_state = MAVLINK_PARSE_STATE_IDLE;
|
status->parse_state = MAVLINK_PARSE_STATE_IDLE;
|
||||||
_MAV_PAYLOAD_NON_CONST(rxmsg)[status->packet_idx+1] = (char)c;
|
_MAV_PAYLOAD_NON_CONST(rxmsg)
|
||||||
|
[status->packet_idx + 1] = (char)c;
|
||||||
memcpy(r_message, rxmsg, sizeof(mavlink_message_t));
|
memcpy(r_message, rxmsg, sizeof(mavlink_message_t));
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
@ -371,7 +375,8 @@ MAVLINK_HELPER uint8_t mavlink_parse_char(uint8_t chan, uint8_t c, mavlink_messa
|
|||||||
// }
|
// }
|
||||||
status->current_rx_seq = rxmsg->seq;
|
status->current_rx_seq = rxmsg->seq;
|
||||||
// Initial condition: If no packet has been received so far, drop count is undefined
|
// Initial condition: If no packet has been received so far, drop count is undefined
|
||||||
if (status->packet_rx_success_count == 0) status->packet_rx_drop_count = 0;
|
if (status->packet_rx_success_count == 0)
|
||||||
|
status->packet_rx_drop_count = 0;
|
||||||
// Count this packet as received
|
// Count this packet as received
|
||||||
status->packet_rx_success_count++;
|
status->packet_rx_success_count++;
|
||||||
}
|
}
|
||||||
@ -400,7 +405,8 @@ MAVLINK_HELPER uint8_t put_bitfield_n_by_index(int32_t b, uint8_t bits, uint8_t
|
|||||||
int32_t v;
|
int32_t v;
|
||||||
uint8_t i_bit_index, i_byte_index, curr_bits_n;
|
uint8_t i_bit_index, i_byte_index, curr_bits_n;
|
||||||
#if MAVLINK_NEED_BYTE_SWAP
|
#if MAVLINK_NEED_BYTE_SWAP
|
||||||
union {
|
union
|
||||||
|
{
|
||||||
int32_t i;
|
int32_t i;
|
||||||
uint8_t b[4];
|
uint8_t b[4];
|
||||||
} bin, bout;
|
} bin, bout;
|
||||||
@ -480,7 +486,8 @@ MAVLINK_HELPER uint8_t put_bitfield_n_by_index(int32_t b, uint8_t bits, uint8_t
|
|||||||
|
|
||||||
*r_bit_index = i_bit_index;
|
*r_bit_index = i_bit_index;
|
||||||
// If a partly filled byte is present, mark this as consumed
|
// If a partly filled byte is present, mark this as consumed
|
||||||
if (i_bit_index != 7) i_byte_index++;
|
if (i_bit_index != 7)
|
||||||
|
i_byte_index++;
|
||||||
return i_byte_index - packet_index;
|
return i_byte_index - packet_index;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -516,7 +523,8 @@ MAVLINK_HELPER void _mavlink_send_uart(mavlink_channel_t chan, const char *buf,
|
|||||||
#else
|
#else
|
||||||
/* fallback to one byte at a time */
|
/* fallback to one byte at a time */
|
||||||
uint16_t i;
|
uint16_t i;
|
||||||
for (i = 0; i < len; i++) {
|
for (i = 0; i < len; i++)
|
||||||
|
{
|
||||||
comm_send_ch(chan, (uint8_t)buf[i]);
|
comm_send_ch(chan, (uint8_t)buf[i]);
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
@ -377,8 +377,8 @@ void mavlink_receiveCallback(uint8_t c)
|
|||||||
mavlink_msg_gps_global_origin_decode(&msg, &gps_org); // 解构msg数据
|
mavlink_msg_gps_global_origin_decode(&msg, &gps_org); // 解构msg数据
|
||||||
// home点经纬高
|
// home点经纬高
|
||||||
sprintf(buf, "{\"lng\":%d,\"lat\":%d,\"alt\":%.2f}",
|
sprintf(buf, "{\"lng\":%d,\"lat\":%d,\"alt\":%.2f}",
|
||||||
gps_org.latitude,
|
|
||||||
gps_org.longitude,
|
gps_org.longitude,
|
||||||
|
gps_org.latitude,
|
||||||
(double)gps_org.altitude / 1000);
|
(double)gps_org.altitude / 1000);
|
||||||
|
|
||||||
if (topicPubMsg[17] != buf)
|
if (topicPubMsg[17] != buf)
|
||||||
@ -494,7 +494,7 @@ void mavlink_receiveCallback(uint8_t c)
|
|||||||
topicPubMsg[1] = buf;
|
topicPubMsg[1] = buf;
|
||||||
}
|
}
|
||||||
// 电流
|
// 电流
|
||||||
sprintf(buf, "%.2f", (double)sys_status.current_battery / 100);
|
sprintf(buf, "%.2f", (double)sys_status.current_battery / 100); // 解构中 1=10毫安 所以这里/100 最终单位是A 安培
|
||||||
if (topicPubMsg[2] != buf)
|
if (topicPubMsg[2] != buf)
|
||||||
{
|
{
|
||||||
topicPubMsg[2] = buf;
|
topicPubMsg[2] = buf;
|
||||||
|
Loading…
Reference in New Issue
Block a user