Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Rover: split DISTANCE_SENSOR onto its own ap_message id

This commit is contained in:
Peter Barker 2018-12-18 21:47:19 +11:00 committed by Peter Barker
parent 77be393ad4
commit f8f5faa6b9
3 changed files with 6 additions and 11 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
APMrover2/GCS_Mavlink.cpp
View File

@ -145,15 +145,15 @@ int16_t GCS_MAVLINK_Rover::vfr_hud_throttle() const
return rover.g2.motors.get_throttle();
}
void Rover::send_rangefinder(mavlink_channel_t chan)
void GCS_MAVLINK_Rover::send_rangefinder() const
{
float distance_cm;
float voltage;
bool got_one = false;
// report smaller distance of all rangefinders
for (uint8_t i=0; i<rangefinder.num_sensors(); i++) {
AP_RangeFinder_Backend *s = rangefinder.get_backend(i);
for (uint8_t i=0; i<rover.rangefinder.num_sensors(); i++) {
AP_RangeFinder_Backend *s = rover.rangefinder.get_backend(i);
if (s == nullptr) {
continue;
}
@ -340,13 +340,6 @@ bool GCS_MAVLINK_Rover::try_send_message(enum ap_message id)
rover.send_servo_out(chan);
break;
case MSG_RANGEFINDER:
CHECK_PAYLOAD_SIZE(RANGEFINDER);
rover.send_rangefinder(chan);
send_distance_sensor();
send_proximity();
break;
case MSG_RPM:
CHECK_PAYLOAD_SIZE(RPM);
rover.send_wheel_encoder(chan);
@ -512,6 +505,7 @@ static const ap_message STREAM_EXTRA3_msgs[] = {
MSG_HWSTATUS,
MSG_WIND,
MSG_RANGEFINDER,
MSG_DISTANCE_SENSOR,
MSG_SYSTEM_TIME,
MSG_BATTERY2,
MSG_BATTERY_STATUS,

2
APMrover2/GCS_Mavlink.h
View File

@ -48,4 +48,6 @@ private:
int16_t vfr_hud_throttle() const override;
void send_rangefinder() const override;
};

1
APMrover2/Rover.h
View File

@ -434,7 +434,6 @@ private:
void send_sys_status(mavlink_channel_t chan);
void send_nav_controller_output(mavlink_channel_t chan);
void send_servo_out(mavlink_channel_t chan);
void send_rangefinder(mavlink_channel_t chan);
void send_pid_tuning(mavlink_channel_t chan);
void send_wheel_encoder(mavlink_channel_t chan);
void send_fence_status(mavlink_channel_t chan);