Print distance according to camera.

Put code to print distance from goal to DriverStationLCD in OI.cpp.