Created new TrajectoryLibrary class to generate and store library of pre-planned trajectories.