Fix bad initialization of Eigen::Vector3d