integrated with robot.cpp
Integrated autonomous, fixed uninitialized vars