Moved and improved coffee_robot