Add SmartDashboard printouts for CV, isPiConnected methods