All pieces work now. Need to implement 2nd degree trajectories