fixed DMP spaz out problem and converted over to p in the motor class