Fixed incorrect autonomous timing, smartdashboard exception still must be fixed