Getting rid of loops

Got rid of while loops in autonomous that were getting us stuck.