adapt to change: lu() now gives partial piv LU, here we want fullPivLu()
adapt to change: lu() now gives partial piv LU, here we want fullPivLu()

robustrobotics/eigen,robustrobotics/eigen,robustrobotics/eigen,robustrobotics/eigen