note that norm2() is *not* an l2 norm as it is in other APIs
note that norm2() is *not* an l2 norm as it is in other APIs

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