diff options
author | Anton Babushkin <anton.babushkin@me.com> | 2014-04-07 17:17:56 +0400 |
---|---|---|
committer | Julian Oes <julian@oes.ch> | 2014-04-18 22:05:45 +0200 |
commit | a66dcbf7e92a1028765f6c5c9a545945ce1a5dc3 (patch) | |
tree | f67f2d99c1171213f19de28adb14088e28194696 /src/modules/mavlink/mavlink_messages.cpp | |
parent | 2cd4648a8e6df65ad953ffe06426c83476b7f835 (diff) | |
download | px4-firmware-a66dcbf7e92a1028765f6c5c9a545945ce1a5dc3.tar.gz px4-firmware-a66dcbf7e92a1028765f6c5c9a545945ce1a5dc3.tar.bz2 px4-firmware-a66dcbf7e92a1028765f6c5c9a545945ce1a5dc3.zip |
mavlink: publish SYS_STATUS at constant rate, don't look at update() result
Diffstat (limited to 'src/modules/mavlink/mavlink_messages.cpp')
-rw-r--r-- | src/modules/mavlink/mavlink_messages.cpp | 31 |
1 files changed, 15 insertions, 16 deletions
diff --git a/src/modules/mavlink/mavlink_messages.cpp b/src/modules/mavlink/mavlink_messages.cpp index 2b5d65080..6b543d44f 100644 --- a/src/modules/mavlink/mavlink_messages.cpp +++ b/src/modules/mavlink/mavlink_messages.cpp @@ -262,22 +262,21 @@ protected: void send(const hrt_abstime t) { - if (status_sub->update(t)) { - mavlink_msg_sys_status_send(_channel, - status->onboard_control_sensors_present, - status->onboard_control_sensors_enabled, - status->onboard_control_sensors_health, - status->load * 1000.0f, - status->battery_voltage * 1000.0f, - status->battery_current * 1000.0f, - status->battery_remaining, - status->drop_rate_comm, - status->errors_comm, - status->errors_count1, - status->errors_count2, - status->errors_count3, - status->errors_count4); - } + status_sub->update(t); + mavlink_msg_sys_status_send(_channel, + status->onboard_control_sensors_present, + status->onboard_control_sensors_enabled, + status->onboard_control_sensors_health, + status->load * 1000.0f, + status->battery_voltage * 1000.0f, + status->battery_current * 1000.0f, + status->battery_remaining, + status->drop_rate_comm, + status->errors_comm, + status->errors_count1, + status->errors_count2, + status->errors_count3, + status->errors_count4); } }; |