Added commands to SmartDashboard