Python Classes for PR2 functionalities used at UW (ported from pr2_python)