Adjust Poses to Point Cloud Surface