fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-26 06:03:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #905 from PX4/distance_fix

Browse Source 
mavlink: Only send the distance sensor message if the topic actually upd...
This commit is contained in:
Thomas Gubler
2014-05-06 13:10:30 +02:00
parent 5bc7295145 df6a0d5a1a
commit 13ad95169f
1 changed files with 14 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mavlink/mavlink_messages.cpp
+14 -13
View File
@@ -1339,22 +1339,23 @@ protected:
void send(const hrt_abstime t) void send(const hrt_abstime t)
{ {
(void)range_sub->update(t); if (range_sub->update(t)) {
uint8_t type; uint8_t type;
switch (range->type) { switch (range->type) {
case RANGE_FINDER_TYPE_LASER: case RANGE_FINDER_TYPE_LASER:
type = MAV_DISTANCE_SENSOR_LASER; type = MAV_DISTANCE_SENSOR_LASER;
break; break;
}
uint8_t id = 0;
uint8_t orientation = 0;
uint8_t covariance = 20;
mavlink_msg_distance_sensor_send(_channel, range->timestamp / 1000, type, id, orientation,
range->minimum_distance*100, range->maximum_distance*100, range->distance*100, covariance);
} }
uint8_t id = 0;
uint8_t orientation = 0;
uint8_t covariance = 20;
mavlink_msg_distance_sensor_send(_channel, range->timestamp / 1000, type, id, orientation,
range->minimum_distance*100, range->maximum_distance*100, range->distance*100, covariance);
} }
}; };