For Team 4 of UW robotics capstone,