Code used in tutorials found on ROS wiki