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
}
