Updated but still problems
-Switch=0 performs differently than Switch=1
-Goes correctly twice, then turns even though still on a line (doesn't back up)