fix hemm to not use the imaginary part of the diagonal entries
fix hemm to not use the imaginary part of the diagonal entries

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