Develop trajectory generation #22

Closed kinematicwolves closed 4 years ago