OMHS 2013 Robot code with working Smartdashboard code