Currently each coordinated turn only includes aileron and elevator action. Rudder action also needs to be included.
The rudder should MATCH the aileron action with some proportion.
Rudder = k * ailerons
Figure out k.
http://www.pilotworkshop.com/tips/rudder_coordinated_flight.htm
In a more complicated manner:
l = 1/2_ρ_V_a^2_S_b_C_l (β, p, r, δa, δr )
n = 1/2_ρ_V_a^2_S_b_C_n (β, p, r, δa, δr )
l and n are roll and yaw moments.
C_n and C_l are non-dimensional, non-linear aerodynamic coefficients dependent on δa, δr, pitch, roll and side slip angle.
We want the proportionality between δr,δa. This is difficult to solve for (there are a few other equations that we need to look at to do that, and it will be a non-linear algebraic system), therefore we need to make approximations.
Whenever the ailerons move, the rudder should also move to support the turn.
The elevator on the other hand (already implemented), is dependent on the roll angle (and not the roll rate). Higher bank angle = less lift = need for elevator