Added rate sleep to the ROS loop