Derivative compensation for speed loop, added or substracted to speed reference