Add documentation
Include missing header.
Provide method to add path planner and path optimizer types in problem solver.
Add a reverse method in Path.
Merge remote-tracking branch 'origin/master' into tmp