Remove usage of InvertPose due to openrave compatibility issues