Cleaned up the code

Moved the SmartDashboard communication to a new class.  Consolidated
the initialization for the VisionProcessing class.  Also put print
statements in the DashboardCommunication class for debugging.