Convert LocalTrajectory to a proper class so the evaluate method can be implemented. Let LocalTrajectoryController use evaluate method.
Add TebObstacleManager to add static obstacles for optimization.
Closes #17 (closed), #19 (closed), #21 (closed)