[发明专利]不依赖模型的非合作卫星相对位姿测量方法有效
申请号: | 201910582131.8 | 申请日: | 2019-06-30 |
公开(公告)号: | CN110308459B | 公开(公告)日: | 2023-05-09 |
发明(设计)人: | 赵高鹏;范佳杰;薄煜明;王超尘;韦雷;黄皓冉 | 申请(专利权)人: | 南京理工大学 |
主分类号: | G01S17/894 | 分类号: | G01S17/894;G01S7/48;G01C21/24 |
代理公司: | 南京理工大学专利中心 32203 | 代理人: | 王玮 |
地址: | 210094 *** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 不依赖 模型 合作 卫星 相对 测量方法 | ||
1.一种不依赖模型的非合作卫星位姿测量方法,其特征在于:针对模型未知的完全非合作卫星,利用激光成像雷达获得的点云和深度图构建非合作卫星的目标坐标系,并利用目标坐标系和激光成像雷达坐标系进行解算,计算得到相对位姿值;其中目标坐标系的构建利用卫星上具有的典型单个圆型部件和本体的一条直线边框完成;包括下述步骤:
步骤(1)、利用激光成像雷达获取第k帧的目标点云Ck及其对应的深度图Dk;
步骤(2)、对第k帧深度图进行直线段检测;
步骤(3)、当k=1时,在第1帧深度图中选取最长的本体边框直线段lk;当k>1时,则在第k帧深度图中寻找与直线段lk-1对应的直线段lk,由点云和深度图的对应关系找到对应的点云点集pk,利用随机采样一致性算法,拟合出三维空间的直线段向量L1;
步骤(4)、对第k帧深度图进行椭圆弧检测;
步骤(5)、当k=1时,在第1帧深度图中选取非合作卫星圆形特征所构成的椭圆弧r1;当k>1时,在第k帧深度图寻找与椭圆弧rk-1对应的椭圆弧rk,由点云和深度图的对应关系找到对应的点云点集qk,利用随机采样一致性算法,求出点集qk所在的空间平面P,记平面P的法向量为L2;
步骤(6)、根据椭圆弧rk的圆心和平面P,求解目标坐标系的原点Q;具体实现方法为:
深度图中任意点可对应空间中的一条射线,Ob为射线OR对平面XOY的投影,α为射线OR和Ob的夹角,β为Ob与Oa之间的夹角;深度图中的任意一点可得到唯一的α和β值,射线的参数方程如下所示
y=x×tan(β)
平面P为对接环所在平面,R为天线保护环的圆心,P'为深度图,R'为深度图上求得的保护环圆心;在已知深度图上一点R'的像素坐标的情况下,从空间中得到一条从激光成像雷达坐标原点O出发的射线,且点R'对应空间点R位于这条射线上;通过计算对接环所在平面与该射线的交点即为天线保护环三维空间圆的圆心,以该圆心R为目标坐标系的原点Q;
步骤(7)、依据L1、L2、Q,建立目标坐标系;
步骤(8)、解算出平移量和旋转量。
2.根据权利要求1所述的不依赖模型的非合作卫星位姿测量方法,其特征在于,实现所述步骤(3)的方法为:
步骤3-1:如果k=1则在第1帧深度图中找到最长的本体边框直线段lk;如果k>1时,则在第k帧深度图中寻找与直线段lk-1对应的直线段lk;
步骤3-2:直线段lk匹配,直线段的匹配根据直线段描述特征的相似度函数来确定,对直线段特征的相似度函数以及直线段的匹配函数分别做如下定义:
直线段长度相似度量函数
直线段梯度幅值相似度量函数
直线段方向相似性度量函数
sm3(lk-1,lk)=cos(φ(lk)-φ(lk-1))
直线段中点位置相似度量函数
其中k代表第k帧,lk代表第k帧中的某条直线段,len(lk)表示第k帧直线段的长度,G(lk)表示第k帧直线的梯度幅值,φ(lk)表示第k帧直线的方向角,表示第k帧直线段的中点坐标;
最后定义直线段的匹配函数
其中wi代表权重;
步骤3-3,由点云和深度图的对应关系找到lk对应的点云点集pk;
步骤3-4,利用随机采样一致性算法,拟合出三维空间的直线段向量Lk。
3.根据权利要求1所述的不依赖模型的非合作卫星位姿测量方法,其特征在于:所述步骤(4)中,检测椭圆弧的对象选取卫星上的圆形目标,包括对接环、抛物面天线。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于南京理工大学,未经南京理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910582131.8/1.html,转载请声明来源钻瓜专利网。