Switched to IterativeRobot, fixed SmartDashboard