Update Robot.java

Shaved a few unnecessary seconds off of the autonomous loop.
Reduce while loops.
update pi conditional.