1
0
Fork 0
NotesUESTC/vslam/PDR优化.md

19 lines
1.5 KiB
Markdown
Raw Blame History

This file contains invisible Unicode characters!

This file contains invisible Unicode characters that may be processed differently from what appears below. If your use case is intentional and legitimate, you can safely ignore this warning. Use the Escape button to reveal hidden characters.

This file contains ambiguous Unicode characters that may be confused with others in your current locale. If your use case is intentional and legitimate, you can safely ignore this warning. Use the Escape button to highlight these characters.

## PDR的优化总结
一、PDR优化效果不明显分析
从逻辑上来讲PDR算法具有一定的独立位置推算能力实际上PDR并没有非常独立的推算能力。经过分析在卡尔曼滤波中利用IMU + PCA计算的方向的权重非常小所以从结果上看IMU并没有发挥其轨迹推算能力导致PDR的效果不明显。直接调大IMU的权重此时轨迹错乱。
二、检验PDR算法的系统效果
简单来说就让手机水平放置使得AHRS算法输出的YAW是正确的验证此时的PDR是否工作正常发现此时的PDR依旧效果存在问题。经过LOG调试分析发现AHRS输出的AHRS的航向角是偏差90度。最终定位到AHRS算法默认采用的是北东地的坐标系经过修改后能够输出正确的偏航角。此时增大IMU的融合权重此时可以观察到PDR算法能够独立推导轨迹效果一般。
三、优化GPS的噪声权重模型
四、卡尔曼模型优化
原版的卡尔曼滤波算法是直接融合IMU提供的方向角和GPS的方向角在这种方式下如果磁力计受到干扰会直接导致PDR的方向出现明显偏移轨迹出错。采用的优化思路是IMU提供角度的增量信息而不是直接提供角度。采用这种方式整体的轨迹比较稳定。
五、性能优化
原版的PDR算法采用的每次IMU更新的时候计算加速度均值的方式判断是否静止这种方式产生的计算量太大了没有必要。主要利用Visual Studio的性能探查器。