mc_pos_control: move position offset limiting to separate method