Use the FK's fork of redundant_manip_control for sot-pr2.