[ros-diffs] [dgoette] 39349: * added comments * continue documentation * formatting * simplify code * change folder structure to separate classes by their usage * fix minor bugs the code review has revealed