fix bug in triangular matrix-vector produce found by eigen2 tests!
fix bug in triangular matrix-vector produce found by eigen2 tests!

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