Develop trajectory generation #21

Closed kinematicwolves closed 4 years ago