Added ros::Rate back in to prevent busy waits.