mk_sense had inconsistent placement of iterators, corrected now
Merge github.com:Pedrogush/Baxter-ROS