Minimum Jerk Trajectory

Alex was the one who told me I needed to implement this.

Given a new cartesian coordinate, with the robot already moving, I need to figure out how to generate a minimum jerk trajectory.