hector_pose_estimation_core: conditionally added some template specializations added in Eigen 3.1 to matrix.h to be compatible with earlier versions