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

Rover Sailboat: reset and Tidy up https://github.com/ArduPilot/ardupilot/pull/26152

This commit is contained in:
Andy Little 2024-02-07 20:46:08 +00:00 committed by Randy Mackay
parent 5c26b40c7e
commit 057d7dca96
2 changed files with 13 additions and 15 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
Rover/sailboat.cpp
View File

@ -172,8 +172,8 @@ void Sailboat::init_rc_in()
} }
} }
// @brief decode pilot mainsail input in manual modes and update the various sail values for different sail types /// @brief decode pilot mainsail input in manual modes and update the various
// ready for SRV_Channel output. /// sail actuator values for different sail types ready for SRV_Channel output.
void Sailboat::set_pilot_desired_mainsail() void Sailboat::set_pilot_desired_mainsail()
{ {
// no RC input means mainsail is moved to trim // no RC input means mainsail is moved to trim
@ -202,7 +202,7 @@ void Sailboat::set_auto_mainsail(float desired_speed)
// mainsail control. // mainsail control.
// //
// mainsail_out represents a range from 0 to 100 // mainsail_out represents a range from 0 to 100
float mainsail_out = 100.f; float mainsail_out = 100.0f;
// main sails cannot be used to reverse // main sails cannot be used to reverse
if (is_positive(desired_speed)) { if (is_positive(desired_speed)) {
// Sails are sheeted the same on each side use abs wind direction // Sails are sheeted the same on each side use abs wind direction
@ -221,13 +221,13 @@ void Sailboat::set_auto_mainsail(float desired_speed)
// wing sails auto trim, we only need to reduce power if we are tipping over, must also be trimmed for correct tack // wing sails auto trim, we only need to reduce power if we are tipping over, must also be trimmed for correct tack
// dont allow to reduce power to less than 0, ie not backwinding the sail to self-right // dont allow to reduce power to less than 0, ie not backwinding the sail to self-right
// wing sails can be used to go backwards, probably not recommended though // wing sails can be used to go backwards, probably not recommended though
const float wing_sail_out_sign = is_negative(desired_speed)?-1.f:1.f; const float wing_sail_out_sign = is_negative(desired_speed) ? -1.0f : 1.0f;
const float wingsail_out = (100.0f - MIN(pid_offset,100.0f)) * wind_dir_apparent_sign * wing_sail_out_sign; const float wingsail_out = (100.0f - MIN(pid_offset,100.0f)) * wind_dir_apparent_sign * wing_sail_out_sign;
rover.g2.motors.set_wingsail(wingsail_out); rover.g2.motors.set_wingsail(wingsail_out);
// //
// direct mast rotation control // direct mast rotation control
// //
float mast_rotation_out = 0.f; float mast_rotation_out = 0.0f;
if (is_positive(desired_speed)) { if (is_positive(desired_speed)) {
// rotating sails can be used to reverse, but not in this version // rotating sails can be used to reverse, but not in this version
if (wind_dir_apparent_abs < sail_angle_ideal) { if (wind_dir_apparent_abs < sail_angle_ideal) {
@ -258,7 +258,6 @@ void Sailboat::set_auto_mainsail(float desired_speed)
mast_rotation_angle *= wind_dir_apparent_sign; mast_rotation_angle *= wind_dir_apparent_sign;
} }
} }
// linear interpolate servo displacement (-100 to 100) from mast rotation angle and restore sign // linear interpolate servo displacement (-100 to 100) from mast rotation angle and restore sign
mast_rotation_out = linear_interpolate(-100.0f, 100.0f, mast_rotation_angle, -sail_angle_max, sail_angle_max); mast_rotation_out = linear_interpolate(-100.0f, 100.0f, mast_rotation_angle, -sail_angle_max, sail_angle_max);
} }
@ -269,8 +268,8 @@ void Sailboat::set_auto_mainsail(float desired_speed)
void Sailboat::relax_sails() void Sailboat::relax_sails()
{ {
rover.g2.motors.set_mainsail(100.0f); rover.g2.motors.set_mainsail(100.0f);
rover.g2.motors.set_wingsail(0.f); rover.g2.motors.set_wingsail(0.0f);
rover.g2.motors.set_mast_rotation(0.f); rover.g2.motors.set_mast_rotation(0.0f);
} }
// calculate throttle and mainsail angle required to attain desired speed (in m/s) // calculate throttle and mainsail angle required to attain desired speed (in m/s)

1
Rover/sailboat.h
View File

@ -71,7 +71,6 @@ private:
// initialise rc input (channel_mainsail) // initialise rc input (channel_mainsail)
void init_rc_in(); void init_rc_in();
// return target heading in radians when tacking (only used in acro) // return target heading in radians when tacking (only used in acro)
float get_tack_heading_rad(); float get_tack_heading_rad();