matlab代码循环运行-KalmanPort:用于四旋翼状态估计的扩展无味卡尔曼滤波器。从Matlab移植到C++/ROS

matlab代码循环运行## Kalman滤波器端口###基于Matlab的代码的移植，用于将Quadrotor的状态估计到C ++ / ROS框架。 （UKF / EKF）。 两种Kalman滤波器实现的状态向量均为14维：#### [位置，速度，方向，imu加速度计偏差，侧倾/俯仰偏差] ####实现使用Boost 1.49，C ++ 11 / STL和ROS Hyrdo ######信息卡尔曼滤波器是一种最佳估计器。 如果可以将系统和观测值的噪声建模为高斯模型，则卡尔曼滤波器可将估计值的均方误差降至最低。 此外，该过滤器是递归的，因此可以在新数据可用时提供状态估计。 如果您有一个很好的估计，那么将滤波器与增益学习的预处理步骤结合使用可以实现一个可靠的系统。 该项目的目的是使用带有IMU和单个摄像机作为系统输入的扩展卡尔曼滤波器或无味卡尔曼滤波器驾驶四旋翼飞行器。 一旦开发出良好的状态估计器，它将与PD控制器结合使用，PD控制器将使用位置和速度估计来计算到达所需位置所需的推力和力矩。 nanoplus四旋翼有一个机载姿态控制器，其运行频率高于位置和速度控制器。 这意味着定向估计将仅