fixes https://github.com/ArduPilot/ardupilot/issues/7054
@ -316,7 +316,7 @@ void AP_L1_Control::update_waypoint(const struct Location &prev_WP, const struct
_prevent_indecision(Nu);
_last_Nu = Nu;
//Limit Nu to +-pi
//Limit Nu to +-(pi/2)
Nu = constrain_float(Nu, -1.5708f, +1.5708f);
_latAccDem = K_L1 * groundSpeed * groundSpeed / _L1_dist * sinf(Nu);