mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-11 10:28:29 -04:00
Updated manual throttle control during throttle hold
This commit is contained in:
parent
a4b8119c24
commit
ba2cfee2fb
@ -1602,9 +1602,12 @@ void update_throttle_mode(void)
|
|||||||
manual_boost,
|
manual_boost,
|
||||||
iterm);
|
iterm);
|
||||||
//*/
|
//*/
|
||||||
|
// this lets us know we need to update the altitude after manual throttle control
|
||||||
reset_throttle_flag = true;
|
reset_throttle_flag = true;
|
||||||
|
|
||||||
}else{
|
}else{
|
||||||
|
// we are under automatic throttle control
|
||||||
|
// ---------------------------------------
|
||||||
if(reset_throttle_flag) {
|
if(reset_throttle_flag) {
|
||||||
set_new_altitude(max(current_loc.alt, 100));
|
set_new_altitude(max(current_loc.alt, 100));
|
||||||
reset_throttle_flag = false;
|
reset_throttle_flag = false;
|
||||||
@ -1920,15 +1923,16 @@ static void update_altitude()
|
|||||||
static void
|
static void
|
||||||
adjust_altitude()
|
adjust_altitude()
|
||||||
{
|
{
|
||||||
if(g.rc_3.control_in <= 180){
|
if(g.rc_3.control_in <= (MINIMUM_THROTTLE + 100)){
|
||||||
// we remove 0 to 100 PWM from hover
|
// we remove 0 to 100 PWM from hover
|
||||||
manual_boost = g.rc_3.control_in - 180;
|
manual_boost = (g.rc_3.control_in - MINIMUM_THROTTLE) -100;
|
||||||
manual_boost = max(-120, manual_boost);
|
manual_boost = max(-100, manual_boost);
|
||||||
update_throttle_cruise();
|
update_throttle_cruise();
|
||||||
|
|
||||||
}else if (g.rc_3.control_in >= 650){
|
}else if (g.rc_3.control_in >= (MAXIMUM_THROTTLE - 100)){
|
||||||
// we add 0 to 100 PWM to hover
|
// we add 0 to 100 PWM to hover
|
||||||
manual_boost = g.rc_3.control_in - 650;
|
manual_boost = g.rc_3.control_in - (MAXIMUM_THROTTLE - 100);
|
||||||
|
manual_boost = min(100, manual_boost);
|
||||||
update_throttle_cruise();
|
update_throttle_cruise();
|
||||||
}else {
|
}else {
|
||||||
manual_boost = 0;
|
manual_boost = 0;
|
||||||
|
Loading…
Reference in New Issue
Block a user