申请/专利权人:深圳市海导科技有限公司
申请日:2023-11-08
公开(公告)日:2024-03-22
公开(公告)号:CN117741699A
主分类号:G01S19/14
分类号:G01S19/14;G01S19/42;G01S19/53;G01C21/20
优先权:
专利状态码:在审-实质审查的生效
法律状态:2024.04.09#实质审查的生效;2024.03.22#公开
摘要:本申请公开了一种获取姿态角的方法、设备及存储介质,方法包括:获取待测载体当前历元的第一三维姿态角,以及获取当前历元的第二三维姿态角;将第一三维姿态角和第二三维姿态角进行互补滤波得到第三三维姿态角;基于第三三维姿态角获取当前历元的初始姿态矩阵;基于初始姿态矩阵得到当前历元的四元素;将四元素进行更新,得到更新后的四元素;基于更新后的四元素更新初始姿态矩阵,得到更新后的姿态矩阵;从更新后的姿态矩阵中获取第四三维姿态角;利用第四三维姿态角与第一三维姿态角进行条件互补滤波得到第五三维姿态角,将第五三维姿态角作为待测载体当前历元的目标三维姿态角输出。本申请能够提高姿态角的精度。
主权项:1.一种获取姿态角的方法,其特征在于,所述方法包括:获取待测载体当前历元的第一三维姿态角,以及获取所述当前历元的第二三维姿态角;将所述第一三维姿态角和所述第二三维姿态角进行互补滤波得到第三三维姿态角;基于所述第三三维姿态角获取当前历元的初始姿态矩阵;基于所述初始姿态矩阵得到所述当前历元的四元素;将所述四元素进行更新,得到更新后的四元素;基于所述更新后的四元素更新所述初始姿态矩阵,得到更新后的姿态矩阵;从所述更新后的姿态矩阵中获取第四三维姿态角;利用所述第四三维姿态角与所述第一三维姿态角进行条件互补滤波得到第五三维姿态角,将所述第五三维姿态角作为所述待测载体当前历元的目标三维姿态角输出。
全文数据:
权利要求:
百度查询: 深圳市海导科技有限公司 获取姿态角的方法、设备及存储介质
免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。