Restructered Autonomous, finished

Everything's finished, now to wait for competition!