ROS Project for UW CSE 481C Robotics Capstone for team 6