Addition to pr2's controller suite for fast execution