Fix bad initializing for Eigen::Vector3d in DARTCollide.cpp