Backtracking Auto (WIP)

If you want the robot to work must finish this code first! Look for the
TODOs