Trajectory planner

  Develop and incorporate a joint space trajectory planner into the controller developed in Step 1. The planner should accept user specified initial and final joint positions, and joint speeds (as percentages of their maximum values).