|
|
|
@ -336,7 +336,7 @@ void AP_L1_Control::update_loiter(const struct Location ¢er_WP, float radius
@@ -336,7 +336,7 @@ void AP_L1_Control::update_loiter(const struct Location ¢er_WP, float radius
|
|
|
|
|
|
|
|
|
|
// scale loiter radius with square of EAS2TAS to allow us to stay
|
|
|
|
|
// stable at high altitude
|
|
|
|
|
radius = loiter_radius(radius); |
|
|
|
|
radius = loiter_radius(fabsf(radius)); |
|
|
|
|
|
|
|
|
|
// Calculate guidance gains used by PD loop (used during circle tracking)
|
|
|
|
|
float omega = (6.2832f / _L1_period); |
|
|
|
|