Document
拖动滑块完成拼图
首页 专利交易 科技果 科技人才 科技服务 国际服务 商标交易 会员权益 IP管家助手 需求市场 关于龙图腾
 /  免费注册
到顶部 到底部
清空 搜索

一种水上激光雷达与惯性导航安装误差标定的方法 

买专利卖专利找龙图腾,真高效! 查专利查商标用IPTOP,全免费!专利年费监控用IP管家,真方便!

申请/专利权人:北京航天控制仪器研究所

摘要:本发明公开了一种水上激光雷达与惯性导航安装误差标定的方法,包括如下步骤:1在N个不同的采集位置,采集相对静态目标A的激光雷达点云数据和惯性导航设备的位置姿态数据;将第k个采集位置采集的相对静态目标A的激光雷达点云数据和惯性导航设备的位置姿态数据分别记为Ck和Ik;2根据Ck和Ik,得到相对静态目标A在激光雷达坐标系中的位置坐标和第k个采集位置在导航坐标系中的位置坐标3根据和基于全局搜索算法,得到激光雷达与惯性导航设备的安装误差E。本发明通过对简单的场景进行采样,应用搜索算法与统计学的方法,实现了激光雷达与惯性导航安装误差标定,提高了标定场景对环境的适应性,同时降低了标定难度。

主权项:1.一种水上激光雷达与惯性导航安装误差标定的方法,其特征在于,包括:在N个不同的采集位置,采集相对静态目标A的激光雷达点云数据和惯性导航设备的位置姿态数据;其中将第k个采集位置采集的相对静态目标A的激光雷达点云数据和惯性导航设备的位置姿态数据分别记为Ck和Ik,表示整数;根据第k个采集位置采集的相对静态目标A的激光雷达点云数据Ck和惯性导航设备的位置姿态数据Ik,得到相对静态目标A在激光雷达坐标系中的位置坐标和第k个采集位置在导航坐标系中的位置坐标其中lidar表示激光雷达坐标系,navi表示导航坐标系;根据和基于全局搜索算法,得到激光雷达与惯性导航设备的安装误差E;根据和基于全局搜索算法,寻找使J值最小的点,即为激光雷达与惯性导航设备的安装误差E: 其中, 表示激光雷达坐标系到惯性导航设备坐标系姿态转换矩阵,表示惯性导航设备坐标系到导航坐标系姿态转换矩阵,θk、ψk、φk分别为第k个采集位置的俯仰角、航向角、横滚角,cov表示协方差矩阵,det表示矩阵的行列式,SE为θ、Δψ、Δφ、Δximu、Δyimu、Δzimu的取值空间;其中Δθ、Δψ、Δφ分别表示激光雷达与惯性导航设备的俯仰角安装误差、航向角安装误差、横滚角安装误差,Δximu、Δyimu、Δzimu表示惯性导航设备坐标系下激光雷达与惯性导航设备的各分量上的位置安装误差,imu表示惯性导航设备坐标系。

全文数据:

权利要求:

百度查询: 北京航天控制仪器研究所 一种水上激光雷达与惯性导航安装误差标定的方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。