Update for Distance from Camera

Added two functions. GetDistance simply returns the current distance. PrintDistance prints it to the SmartDashboard. #include "SmartDashboard/SmartDashboard.h"
#include "WPILib.h" are necessary for these functions!