使用了扩展卡尔曼，完成了UWB和惯导的数据融合，并实现了仿真。代码几乎都有注释，可以很好的起到事例作用。