Final race code

Here's the code from today with two reflectance sensors. Disregard the commit about curvefitting, it was just something I experimented with