用EKF算法进行仿真，模拟了PMSM的电机动态数据，取得良好效果

国外一款非线性估计的工具箱，粒子滤波、UKF、EKF等应有尽有

ekf，即扩展卡尔曼滤波器，对于研究电机滑膜控制有所帮助

用于参数辨识研究，可以对多参数的非线性函数进行拟合与参数识别

扩展卡尔曼滤波器（EKF） 3 非线性系统的卡尔曼滤波方程 3.1 扩展卡尔曼滤波器 非线性系统模型： 其中： 假设在 时刻已获得系统状态 的滤波估计 ，将 和 在 附近线性化，即非线性系统将随时在新估计的结果附近进行线性化。

CSDN博客:《非线性滤波——基于EKF的INS/GPS松组合算法的研究（间接法|EKF|欧拉角）》附件资源 博文地址：https://blog.csdn.net/tsuibeyond/article/details/104059643 摘要：在之前的博文《非线性滤波——基于EKF的INS/GPS松组合算法的研究（直接法|EKF|欧拉角）》中，我们记录了直接形式的EKF实现INS/GPS松组合算法，并在《卡尔曼滤波——直接法VS间接法》中对比说明了直接法与间接法的优劣。本文，我们记录使用间接反馈校正形式的EKF算法实现INS/GPS松组合算法。

组合导航相关算法使用c++文件，INS/GPS组合导航算法

魔改卡尔曼扩展滤波器 robot_pose_ekf，我用的系统环境ros-noetic，其它环境可以自己测一下，应该没问题；里面有readme详细说明，b站视频中有简要说明 https://b23.tv/WWQRJGF

功能：扩展卡尔曼滤波EKF的测量更新 % 输入： % GPSDat——当前时刻GPS定位定速结果，维数：1*7，时刻（s）、位置（m，n0系） 和速度（m/s，n系）； % MIMURes—— SINS惯导积分解算结果结构体，其元素有： % MIMURes.MIMUTime 当前时刻 MIMU测量数据的时刻值 % MIMURes.dt 当前时刻积分时间间隔（s） % MIMURes.Cb2n 当前时刻 MIMU所在载体b系到当地NED n系的方向余弦矩阵 % MIMURes.Qua 当前时刻 n系到 b系的旋转四元数 % MIMURes.Att 当前时刻 n系到 b系的旋转欧拉角（321转序），滚动角、俯仰角、偏航角，量纲：rad ； % MIMURes.Vel 当前时刻 b系相对于 n系的平动速度，当地北东地坐标系 n系，单位：m/s % MIMURes.BLH 当前时刻 b系所在位置的大地坐标，纬度(rad)、经度(rad)和高度(m) % NavEarthPar——与导航相关的地球物理参数结构体，有9个元素： % NavEarthPar.Grav_n n系

对比不同卡尔曼滤波器的性能包括EKF,UKF,GSF-EKF,IMM-EKF,IMM-UKF以及粒子群滤波