New sensor constants updated
Pushed my main code: which has driveForward, but untested yet
fixed conflicts