Change getcurrentspeed to getcurrentsetpoint()