Use pre-increment iterators

The pre-increment fix helps build ROS software pass strict cppcheck controls, and help spot important problems by avoiding to clutter the output.