fixed a template type conversion bug in AngleAxis found by Pei Luo
fixed a template type conversion bug in AngleAxis found by Pei Luo

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