Still broken... This math stuff is hard
Currently working to properly implement Trajectory as a parametric curve