mirror of https://github.com/ArduPilot/ardupilot
Loiter I reset
This commit is contained in:
parent
e9d41897df
commit
e17c8705ba
|
@ -1391,8 +1391,6 @@ static void update_navigation()
|
|||
// reset LOITER to current position
|
||||
next_WP = current_loc;
|
||||
|
||||
// clear Loiter Iterms
|
||||
//reset_nav();
|
||||
}else{
|
||||
// this is also set by GPS in update_nav
|
||||
wp_control = LOITER_MODE;
|
||||
|
|
|
@ -239,12 +239,12 @@ static void reset_nav(void)
|
|||
nav_throttle = 0;
|
||||
invalid_throttle = true;
|
||||
|
||||
//g.pi_nav_lat.reset_I();
|
||||
//g.pi_nav_lon.reset_I();
|
||||
g.pi_nav_lat.reset_I();
|
||||
g.pi_nav_lon.reset_I();
|
||||
|
||||
// considering not reseting wind control
|
||||
//g.pi_loiter_lat.reset_I();
|
||||
//g.pi_loiter_lon.reset_I();
|
||||
g.pi_loiter_lat.reset_I();
|
||||
g.pi_loiter_lon.reset_I();
|
||||
|
||||
circle_angle = 0;
|
||||
crosstrack_error = 0;
|
||||
|
|
Loading…
Reference in New Issue