[发明专利]一种分布式POS多节点多参量瞬间同步标校方法有效
申请号: | 201910951939.9 | 申请日: | 2019-10-09 |
公开(公告)号: | CN110672094B | 公开(公告)日: | 2021-04-06 |
发明(设计)人: | 宁晓琳;刘艳红;胡佳;王博 | 申请(专利权)人: | 北京航空航天大学 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01C21/20;G01C25/00 |
代理公司: | 北京科迪生专利代理有限责任公司 11251 | 代理人: | 安丽;邓治平 |
地址: | 100191*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 分布式 pos 节点 参量 瞬间 同步 校方 | ||
1.一种分布式POS多节点多参量瞬间同步标校方法,其特征在于,包括以下步骤:
第一步,第一相机和第二相机分别拍摄第一标定板和第二标定板,多次变化相机位置,基于手眼标定模型标定出无公共视场的第一相机和第二相机之间的相对位姿关系;
第二步,第一相机和第二相机分别拍摄主节点靶标和子节点靶标,主节点靶标、子节点靶标分别粘贴在主POS和子IMU的表面,通过单目视觉完成主靶标和子靶标分别在第一相机坐标系和第二相机坐标系下的位姿测量;
第三步,经过第一标定板、第二标定板和IMU的已知尺寸信息将靶标坐标系转换到IMU坐标系下,计算第一相机和第二相机分别和主POS、子IMU的相对位姿关系,最后获取主节点和子节点间的相对位姿,通过扩展相机,实现多个节点间的相对位置和姿态的实时测量,完成多节点瞬间同步标校;
所述第一步中,标定出无公共视场的第一相机和第二相机的相对位姿关系,具体包括:
(1)将第一标定板和第二标定板通过一连杆刚性固连,第一相机和第二相机通过三脚架刚性固连;第一标定板和第二标定板采用陶瓷材质,并刻有棋盘格或者圆点特征点图案,特征点间距已知;
(2)第一相机和第二相机分别拍摄所述第一标定板和第二标定板,各获取一幅图像,计算出标定板和相机之间的相对位姿,多次变换相机位置,通过相机移动前后,第一相机和第二相机相对位姿关系不变的约束条件,利用手眼标定模型标定出第一相机和第二相机之间的相对位姿关系。
2.根据权利要求1所述的一种分布式POS多节点多参量瞬间同步标校方法,其特征在于,所述步骤(2)中,第一相机和第二相机相对位姿关系不变的约束条件标定出第一相机和第二相机之间的位姿关系,具体包括步骤:
对于第一相机,初始时刻第一相机和第一标定板之间的位姿关系为A0,第一相机移动K次,K≥20,每次移动,第一相机和第一标定板之间的位姿记作Ak,k=1…K,则相对于初始时刻第一相机的摆放位置,第一相机的位姿为T1k,对于第二相机,初始时刻第二相机和第二标定板之间的位姿为B0,第二相机移动K次,每次移动第二相机和第二标定板之间的位姿记作Bk,则相对于初始时刻第二相机的摆放位置,第二相机的位姿为
其中,Ak包括旋转Rk和平移tk关系,
相机移动前后,以第一相机和第二相机之间的位姿关系不变为约束条件,有如下公式:
其中,T3表示第一相机和第二相机之间的位姿关系,通过解该方程计算第一相机和第二相机之间的位姿关系。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京航空航天大学,未经北京航空航天大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910951939.9/1.html,转载请声明来源钻瓜专利网。