Replace dense Schur with QR solver for pose refinement