F octomap

[carebare47]

Proposed changes

Please explain the changes you made. Add pictures or videos to explain them better if appropriate.

Checklist

If the task is applicable to this pull request (see applicability criteria in brackets), make sure it is completed before checking the corresponding box. Otherwise, tick the box right away. Make sure that ALL boxes are checked BEFORE the PR is merged.

• Manually tested that added code works as intended (if any functional/runnable code is added).
• Added automated tests (if a new class is added (Python or C++), interface of that class must be unit tested).
• Tested on real hardware (if the changed or added code is used with the real hardware).
• Added documentation (For any new feature, explain what it does and how to use it. Write the documentation in a relevant space, e.g. Github, Confluence, etc.)