namespace Passer.LinearAlgebra { public class SwingTwist { public Direction swing; public float twist; public static readonly SwingTwist zero = new(0, 0, 0); public SwingTwist(Direction swing, float twist) { this.swing = swing; this.twist = twist; } public SwingTwist(float horizontalSwing, float verticalSwing, float twist) { this.swing = new Direction(horizontalSwing, verticalSwing); this.swing.Normalize(); this.twist = twist; } public static SwingTwist FromQuat32(Quat32 q32) { // UnityEngine.Quaternion q = new(q32.x, q32.y, q32.z, q32.w); // SwingTwist r = new(q.eulerAngles.y, q.eulerAngles.x, q.eulerAngles.z); q32.ToAngles(out float right, out float up, out float forward); SwingTwist r = new(up, right, forward); return r; } } }