change getCurrentSetPoint in changeSpeed method to getSpeed