/// <summary>
/// function get ToTrueScapeHeading
/// </summary>
/// <param name="q">
/// input ScapeOrientation
/// </param>
/// <returns>
/// returns ToTrueScapeHeading in degrees
/// </returns>
public static float ToTrueScapeHeading(this ScapeOrientation q)
{
Quaternion globalOrientationCamToNwd = q.ToQuaternion();
// Project the camera outward facing z-axis into the NWD-frame
Vector3 unitZ = new Vector3(0, 0, 1);
Vector3 cameraDirectionInNwd = globalOrientationCamToNwd * unitZ;
// The heading is the angle between the projection of z onto the xy-plane in the NWD-frame
float heading = Mathf.Atan2(cameraDirectionInNwd.y, cameraDirectionInNwd.x);
// Heading is measured from [0, 2*pi], not [-pi, pi]
if (heading < 0.0f)
{
heading += 2 * Mathf.PI;
}
// Convert from radians to degrees and return
float trueHeading = heading * 180 / Mathf.PI;
return(trueHeading);
}
/// <summary>
/// function get Roll
/// </summary>
/// <param name="o">
/// input ScapeOrientation
/// </param>
/// <returns>
/// returns Roll in radians
/// </returns>
public static float Roll(this ScapeOrientation o)
{
var q = o.ToQuaternion();
return(Mathf.Atan2(2.0f * ((q.x * q.y) + (q.w * q.z)), (q.w * q.w) + (q.x * q.x) - (q.y * q.y) - (q.z * q.z)));
}
/// <summary>
/// function get Pitch
/// </summary>
/// <param name="o">
/// input ScapeOrientation
/// </param>
/// <returns>
/// returns Pitch in radians
/// </returns>
public static float Pitch(this ScapeOrientation o)
{
var q = o.ToQuaternion();
return(Mathf.Asin(-2.0f * ((q.x * q.z) - (q.w * q.y))));
}