一种六推无人机加速器测量值的滤波优化方法及其系统
基本信息
申请号 | CN201811485762.X | 申请日 | - |
公开(公告)号 | CN109655057B | 公开(公告)日 | 2021-05-25 |
申请公布号 | CN109655057B | 申请公布日 | 2021-05-25 |
分类号 | G01C21/16(2006.01)I | 分类 | - |
发明人 | 王盛炜;黄俊平;陈汉良 | 申请(专利权)人 | 深圳市吉影科技有限公司 |
代理机构 | 深圳市科进知识产权代理事务所(普通合伙) | 代理人 | 曹卫良 |
地址 | 518000广东省深圳市南山区西丽街道留仙洞中山园路1001号TCL科学园区研发楼F3栋201-1号 | ||
法律状态 | - |
摘要
摘要 | 本发明涉及六推无人机技术领域,特别涉及一种六推无人机加速器测量值的滤波优化方法及其系统;本发明先通过卡尔曼滤波器对K时刻的加速度测量值进行滤波;再获取K时刻的加速度测量值和加速度预测值;从而得到K时刻的协方差;再计算出K时刻的卡尔曼增益;然后得到K时刻的最优预测值;通过K时刻的最优预测值进行迭代计算,得到K+1时刻的最优预测值;本发明对加速器测量值进行实时滤波优化,获得更加接近真实加速度的测量数据;对滤波优化后的加速度数据进行二次积分处理,能够获得更加准确的水下无人机位移数据,大幅降低测量加速度的非真实极值出现概率和误差,提高通过九轴运动姿态模块实现水下无人机定位的精度。 |
