changed priority of PIDController to run before motor updates but after IME test