point_cloud: back ported changes to pc iteration

fixes #715 for me
Merge pull request #721 from ros-visualization/issue_715

point_cloud: back ported changes to pc iteration