Added SmartDashboard testing in Robot.