Please explain the changes you made, including a reference to the related issue if applicable
- Required: Code is auto formatted using clang-format
- Extended the tutorials / documentation, if necessary reference
- Include a screenshot if changing a GUI
- Optional: Created tests, which fail without this PR reference
- Optional: Decide if this should be cherry-picked to other current ROS branches (Indigo, Jade, Kinetic)