[ros-diffs] [khornicek] 37508: - reshuffle the code a bit - fix CID 521 run 2