public BezierTrajectory(Bezier3 trajectory)
{
Trajectory = trajectory;
Length = Trajectory.Length();
Magnitude = (Trajectory.d - Trajectory.a).magnitude;
DeltaAngle = Trajectory.DeltaAngle();
Direction = (Trajectory.d - Trajectory.a).normalized;
StartDirection = (Trajectory.b - Trajectory.a).normalized;
EndDirection = (Trajectory.c - Trajectory.d).normalized;
}