Added Pioneer 5DOF Manipulator Functionality