renaming the new functions

This commit is contained in:
Thomas
2020-11-02 17:25:39 +01:00
committed by Silvan Fuhrer
parent 9cc9e4f89f
commit f1524fe27d
2 changed files with 22 additions and 22 deletions
+14 -14
View File
@@ -520,7 +520,7 @@ void MavlinkReceiver::handle_message_command_both(mavlink_message_t *msg, const
if (cmd_mavlink.command == MAV_CMD_DO_CHANGE_SPEED) { if (cmd_mavlink.command == MAV_CMD_DO_CHANGE_SPEED) {
// Not differentiating between airspeed and groundspeed yet // Not differentiating between airspeed and groundspeed yet
set_cruising_speed(cmd_mavlink.param2); set_offb_cruising_speed(cmd_mavlink.param2);
} }
if (!send_ack) { if (!send_ack) {
@@ -1083,7 +1083,7 @@ MavlinkReceiver::handle_message_set_position_target_global_int(mavlink_message_t
globallocalconverter_tolocal(set_position_target_global_int.lat_int / 1e7, globallocalconverter_tolocal(set_position_target_global_int.lat_int / 1e7,
set_position_target_global_int.lon_int / 1e7, set_position_target_global_int.alt, set_position_target_global_int.lon_int / 1e7, set_position_target_global_int.alt,
&pos_sp_triplet.current.x, &pos_sp_triplet.current.y, &pos_sp_triplet.current.z); &pos_sp_triplet.current.x, &pos_sp_triplet.current.y, &pos_sp_triplet.current.z);
pos_sp_triplet.current.cruising_speed = get_cruising_speed(); pos_sp_triplet.current.cruising_speed = get_offb_cruising_speed();
pos_sp_triplet.current.position_valid = true; pos_sp_triplet.current.position_valid = true;
} }
@@ -2975,7 +2975,7 @@ MavlinkReceiver::Run()
// reset cruising speed on mode changes // reset cruising speed on mode changes
if (_vehicle_status_sub.update(&_vehicle_status)) { if (_vehicle_status_sub.update(&_vehicle_status)) {
if (_last_nav_state != _vehicle_status.nav_state) { if (_last_nav_state != _vehicle_status.nav_state) {
reset_cruising_speed(); reset_offb_cruising_speed();
_last_nav_state = _vehicle_status.nav_state; _last_nav_state = _vehicle_status.nav_state;
} }
} }
@@ -3131,19 +3131,19 @@ MavlinkReceiver::receive_start(pthread_t *thread, Mavlink *parent)
} }
float float
MavlinkReceiver::get_cruising_speed() MavlinkReceiver::get_offb_cruising_speed()
{ {
if (_vehicle_status.vehicle_type == vehicle_status_s::VEHICLE_TYPE_ROTARY_WING) { if (_vehicle_status.vehicle_type == vehicle_status_s::VEHICLE_TYPE_ROTARY_WING) {
if (_cruising_speed_mc > 0.0f) { if (_offb_cruising_speed_mc > 0.0f) {
return _cruising_speed_mc; return _offb_cruising_speed_mc;
} else { } else {
return -1.0f; return -1.0f;
} }
} else { } else {
if (_cruising_speed_fw > 0.0f) { if (_offb_cruising_speed_fw > 0.0f) {
return _cruising_speed_fw; return _offb_cruising_speed_fw;
} else { } else {
return -1.0f; return -1.0f;
@@ -3152,19 +3152,19 @@ MavlinkReceiver::get_cruising_speed()
} }
void void
MavlinkReceiver::set_cruising_speed(float speed) MavlinkReceiver::set_offb_cruising_speed(float speed)
{ {
if (_vehicle_status.vehicle_type == vehicle_status_s::VEHICLE_TYPE_ROTARY_WING) { if (_vehicle_status.vehicle_type == vehicle_status_s::VEHICLE_TYPE_ROTARY_WING) {
_cruising_speed_mc = speed; _offb_cruising_speed_mc = speed;
} else { } else {
_cruising_speed_fw = speed; _offb_cruising_speed_fw = speed;
} }
} }
void void
MavlinkReceiver::reset_cruising_speed() MavlinkReceiver::reset_offb_cruising_speed()
{ {
_cruising_speed_mc = -1.0f; _offb_cruising_speed_mc = -1.0f;
_cruising_speed_fw = -1.0f; _offb_cruising_speed_fw = -1.0f;
} }
+8 -8
View File
@@ -123,14 +123,14 @@ public:
static void *start_helper(void *context); static void *start_helper(void *context);
/** /**
* Get the cruising speed * Get the cruising speed in offboard control
* *
* @return the desired cruising speed for the current flight mode * @return the desired cruising speed for the current flight mode
*/ */
float get_cruising_speed(); float get_offb_cruising_speed();
/** /**
* Set the cruising speed * Set the cruising speed in offboard control
* *
* Passing a negative value or leaving the parameter away will reset the cruising speed * Passing a negative value or leaving the parameter away will reset the cruising speed
* to its default value. * to its default value.
@@ -138,12 +138,12 @@ public:
* Sets cruising speed for current flight mode only (resets on mode changes). * Sets cruising speed for current flight mode only (resets on mode changes).
* *
*/ */
void set_cruising_speed(float speed = -1.0f); void set_offb_cruising_speed(float speed = -1.0f);
/** /**
* Reset all cruising speeds to default values * Reset all offboard cruising speeds to default values
*/ */
void reset_cruising_speed(); void reset_offb_cruising_speed();
private: private:
@@ -342,8 +342,8 @@ private:
vehicle_status_s _vehicle_status{}; vehicle_status_s _vehicle_status{};
uint8_t _last_nav_state{0}; uint8_t _last_nav_state{0};
float _cruising_speed_mc{-1.0f}; float _offb_cruising_speed_mc{-1.0f};
float _cruising_speed_fw{-1.0f}; float _offb_cruising_speed_fw{-1.0f};
// Allocated if needed. // Allocated if needed.
TunePublisher *_tune_publisher{nullptr}; TunePublisher *_tune_publisher{nullptr};