Add a few methods in Matrix3fX and Vec3fX:

  Matrix3fX::isIdentity,
  Vec3fX::norm, Vec3fX::squaredNorm,
  Vec3fX::setZero,
  operator * (double, Vec3fX)

This commit Tries to homogeneize interface with Eigen.