mc_pos_control: calculate velocity error derivative without setpoint acceleration to get more clean output