Sean and Bryant code unified into robotics_1_main