Use unblocked version if the matrix is too small, plus some cleaning.
Use unblocked version if the matrix is too small, plus some cleaning.

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