mc_pos_control: added NaN protection to target velocity filtering
mc_pos_control: typo in comment fixed