Add documents
Add octomap parameter functions