increase stability and use column pivoted HouseholderQr for gauss newton
increase stability and use column pivoted HouseholderQr for gauss newton

BerlinUnited/NaoTH,BerlinUnited/NaoTH,BerlinUnited/NaoTH,BerlinUnited/NaoTH,BerlinUnited/NaoTH,BerlinUnited/NaoTH,BerlinUnited/NaoTH