Update Sensors_1410 v3 code.c

Updated autonomous #1 using the sensors