Split the planner and kinematics out into their own libraries. Fixed the final motion point of the planning test to stop rather than jerk.