public void GetControlAngles(out double theta_0, out double theta_sin, out double theta_cos, out double theta_p) { MainRotor.GetControlAngles(out theta_0, out theta_sin, out theta_cos); double dummy; TailRotor.GetControlAngles(out theta_p, out dummy, out dummy); }
public void SetControlAngles(double theta_0, double theta_sin, double theta_cos, double theta_p) { double ntheta_0, ntheta_sin, ntheta_cos, ntheta_p, dummy; MainRotor.GetNormalizedControlAngles(theta_0, theta_sin, theta_cos, out ntheta_0, out ntheta_sin, out ntheta_cos); TailRotor.GetNormalizedControlAngles(theta_p, 0, 0, out ntheta_p, out dummy, out dummy); Collective = ntheta_0; LongCyclic = ntheta_sin; LatCyclic = ntheta_cos; Pedal = -ntheta_p; // TODO make pedal-collective inversion a parameter }