源码可在https://github.com/learnmoreonce/SLAM 下载
文件:kalman_filter/gaussian_distribution.h
#ifndef CARTOGRAPHER_KALMAN_FILTER_GAUSSIAN_DISTRIBUTION_H_
#define CARTOGRAPHER_KALMAN_FILTER_GAUSSIAN_DISTRIBUTION_H_
#include "Eigen/Cholesky"
#include "Eigen/Core"
#include "Eigen/Geometry"
namespace cartographer {
namespace kalman_filter {
/*
高斯分布类
构造函数是N*1的均值矩阵和N*N的协方差矩阵
*/
template <typename T,