Update Sensors_1410 v3 code.c

Clean up and update the autonomous