ROS State Machine for Delivering Coffee