CN107967700A - 大视场宽工作距双目相机的在轨几何校正及精度验证方法 - Google Patents

大视场宽工作距双目相机的在轨几何校正及精度验证方法 Download PDF

Info

Publication number
CN107967700A
CN107967700A CN201711250032.7A CN201711250032A CN107967700A CN 107967700 A CN107967700 A CN 107967700A CN 201711250032 A CN201711250032 A CN 201711250032A CN 107967700 A CN107967700 A CN 107967700A
Authority
CN
China
Prior art keywords
mrow
msub
mtd
mtr
msubsup
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201711250032.7A
Other languages
English (en)
Other versions
CN107967700B (zh
Inventor
吴奋陟
王晓燕
王立
张成龙
张丽华
刘鲁
李涛
梁潇
高文文
李全良
王京海
邹月
郭健
郑岩
张运方
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Control Engineering
Original Assignee
Beijing Institute of Control Engineering
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Control Engineering filed Critical Beijing Institute of Control Engineering
Priority to CN201711250032.7A priority Critical patent/CN107967700B/zh
Publication of CN107967700A publication Critical patent/CN107967700A/zh
Application granted granted Critical
Publication of CN107967700B publication Critical patent/CN107967700B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/80Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
    • G06T7/85Stereo camera calibration
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/30Subject of image; Context of image processing
    • G06T2207/30204Marker

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Other Investigation Or Analysis Of Materials By Electrical Means (AREA)

Abstract

大视场宽工作距双目相机的在轨几何校正及精度验证方法,涉及光学成像敏感器在轨标定技术领域;其步骤包括:星上靶标地面定标、双目相机六自由度运动、双目相机采集星上靶标图像、在轨参数解算、精度评估;本发明通过合理规划测例使得大视场双目相机的全视场均能得到有效标定;方法通过整体最优估计,同时求解双目相机的内、外参数,以保证相机参数的估计值能够使单个相机的物像共线关系、双相机之间的空间约束关系同时达到最优;方法考虑了光学***的畸变修正,保证了相机的标定精度;方法利用双目相机测量的空间几何约束关系验证在轨校正精度,使得在轨精度验证不依赖于目标的绝对位置数据;标定参数可用于空间机械臂在轨标定。

Description

大视场宽工作距双目相机的在轨几何校正及精度验证方法
技术领域
本发明涉及一种双目相机的在轨几何校正及精度验证方法,特别是大视场宽工作距双目相机的在轨几何校正及精度验证方法。
背景技术
现有技术主要是针对单个相机在轨几何校正提出的方法。方法一般采用严格解析法或利用二次曲线等约束关系求解相机参数。前者在共线方程的基础上通过直接线性变换求解相机的焦距和图像中心等内参数,由于不考虑相机光学***畸变误差,标定精度难以满足相机高精度测量的需要;另一方面,空间星上资源有限,相机和目标的安装位置相对固定,方法通常只能利用1张图像中少量的目标点标定相机参数,无法满足大视场、宽工作距相机全部视场和工作距离测量的需要。后一种方法不使用几何信息,利用二次曲线、二次曲面对相机内参数的约束关系线性求解相机参数,仅能够标定焦距、图像中心等内参数,无法提供相机的位置和姿态等外参数;由于约束关系不基于严格的物像对应关系,使得方法鲁棒性差。上述方法主要针对单个相机在轨参数标定需求,无法提供双目相机测量所需的左、右目相机之间的空间位置和姿态。精度验证方面,通常采用计算单个相机指向精度的方法,以及计算双目视觉***三维恢复精度的方法验证双目相机参数的标定精度。上述验证方法需要目标的绝对位置坐标作为先验信息,不适用于在轨精度评估。
发明内容
本发明的目的在于克服现有技术的上述不足,提供大视场宽工作距双目相机的在轨几何校正及精度验证方法,通过合理规划测例使得大视场双目相机的全视场均能得到有效标定;同时求解双目相机的内、外参数,以保证相机参数的估计值能够使单个相机的物像共线关系、双相机之间的空间约束关系同时达到最优;保证了相机的标定精度;
本发明的上述目的是通过如下技术方案予以实现的:
大视场宽工作距双目相机的在轨几何校正及精度验证方法,包括如下步骤:
步骤(一)、利用摄影测量相机对星上靶标上的N个反射目标进行空间位置测量,测量N个反射目标的几何中心在星上靶标本体坐标系OCXCYCZC下的位置,设第i个反射目标的坐标值为(XCi,YCi,ZCi);XCi,YCi,ZCi分别为第i个反射目标在星上靶标本体坐标系XC方向、YC方向和ZC方向的坐标分量;N为大于等于100的正整数;1≤i≤N,且i为正整数;
步骤(二)、在星上靶标上方10cm位置处安装基准镜;架设第一经纬仪A1、第二经纬仪A2和第三经纬仪A3,利用第一经纬仪A1、第二经纬仪A2和第三经纬仪A3准直建立基准镜坐标系OJXJYJZJ
步骤(三)、从N个反射目标中选取U个目标,利用第一经纬仪A1和第三经纬仪A3测量U个目标的几何中心在基准镜坐标系下的位置;设第k个反射目标在基准镜坐标系的坐标值为(XJK,YJK,ZJK);其中,XJK,YJK,ZJK分别为第k个反射目标在基准镜坐标系XJ方向、YJ方向和ZJ方向的坐标分量;10≤U≤N,且U为正整数;1≤k≤U,且k为正整数;
步骤(四)、根据步骤(一)和步骤(三)获得的数据,计算星上靶标N个反射目标的几何中心在基准镜坐标系下OJXJYJZJ的坐标值(XJi,YJi,ZJi);XJi,YJi,ZJi分别为第i个反射目标在基准镜坐标系XJ方向、YJ方向和ZJ方向的坐标分量;
步骤(五)、建立双目相机辅助坐标系OFXFYFZF;调整双目相机,实现双目相机辅助坐标系OFXFYFZF相对于基准镜坐标系OJXJYJZJ的角度为相对位置为(0,0,L1);其中,θ1,κ1分别表示双目相机第一次调整到位时,双目相机辅助坐标系OFXFYFZF相对于基准镜坐标系OJXJYJZJ的俯仰角、偏航角和滚转角;L1表示双目相机辅助坐标系的原点在基准镜坐标系下正ZJ方向的坐标分量;
步骤(六)、双目相机第一次调整到指定位置后,建立左目相机图像坐标系OLxLyL和右目相机图像坐标系ORxRyR;对星上靶标上的反射目标成像;左目相机的成像图像为PL1;右目相机的成像图像为PR1;测量N个反射目标分别在左、右目相机图像坐标系下的成像位置(xiL1,yiL1)和(xiR1,yiR1);xiL1,yiL1分别表示第i个反射目标在左目相机第1张图像的左目相机图像坐标系OLxLyL下xL和yL方向的坐标分量;xiR1,yiR1分别表示第i个反射目标在右目相机第1张图像的右目相机图像坐标系ORxRyR下xR和yR方向的坐标分量;
步骤(七)、重复步骤(五)和步骤(六),对双目相机进行m次调整,10≤m≤N;双目相机辅助坐标系OFXFYFZF相对于基准镜坐标系OJXJYJZJ的角度为相对位置为(0,0,Lm);θm,κm分别表示机械臂第m次调整到位时,双目相机辅助坐标系OFXFYFZF相对基准镜坐标系OJXJYJZJ的俯仰角、偏航角和滚转角,Lm表示双目相机辅助坐标系OFXFYFZF原点在基准镜坐标系OJXJYJZJ下ZJ方向的坐标分量;PLm表示左目相机拍摄的第m张图像;PRm表示右目相机拍摄的第m张图像;测量N个反射目标分别在左、右目相机图像坐标系下的成像位置(xiLm,yiLm)和(xiRm,yiRm);xiLm,yiLm分别表示第i个反射目标在左目相机第m张图像的左目相机图像坐标系OLxLyL下xL和yL方向的坐标分量;xiRm,yiRm分别表示第i个反射目标在右目相机第m张图像的右目相机图像坐标系ORxRyR下xR和yR方向的坐标分量;
步骤(八)、将步骤(四)和步骤(七)的测量数据一一对应,分别建立左目相机和右目相机的反射目标像点位置的修正方程;并计算左目相机内参数、左目相机拍摄图像时的摄站外参数,以及右目相机内参数、右目相机拍摄图像时的摄站外参数;
步骤(九)、根据步骤(八)计算得到的左目相机摄站外参数和右目相机摄站外参数计算左、右目相机之间的位置和姿态;
步骤(十)、从m对图像中任选一张,根据步骤(八)和步骤(九)计算的左目相机内参数、外参数,以及左、右目相机之间的位置和姿态计算双目相机在轨标定后的精度。
在上述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,所述步骤(一)中,星上靶标本体坐标系OCXCYCZC的建立方法为:以星上靶标中心标志的位置为星上靶标本体坐标系原点OC,中心标志与其右侧标志的连线为正XC方向,中心标志与其上方标志连线与正XC方向叉乘后的方向为正ZC方向,正YC方向按照右手法则确定。
在上述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,所述步骤(二)中,第一经纬仪A1、第二经纬仪A2和第三经纬仪A3的架设方法为:沿基准镜的前端面法线方向架设第一经纬仪A1,第一经纬仪A1距基准镜的距离不小于1m;沿基准镜的侧端面法线方向架设第二经纬仪A2,第二经纬仪A2距基准镜的距离不小于1m;第三经纬仪A3位于与第一经纬仪A1的左侧,且对星上靶标的观测夹角不小于60°。
在上述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,所述步骤(二)中,基准镜坐标系OJXJYJZJ的建立方法为:以基准镜的几何中心为坐标系原点OJ,基准镜前端面法线指向基准镜安装面的方向为正ZJ方向;基准镜侧端面法线指向星上靶标的方向为正YJ方向;正ZJ按照右手法则定义。
在上述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,所述步骤(四)中,第i个反射目标的几何中心在基准镜坐标系下的坐标值(XJi,YJi,ZJi)的计算方法为:
R=(A·BT)·(B·BT)-1 (7)
式中,(XCk,YCk,ZCk)表示U个反射目标中,第k个目标的几何中心在星上靶标本体坐标系下的坐标值;
表示U个反射目标的重心在星上靶标本体坐标系下的坐标值;
(XJk,YJk,ZJk)表示U个反射目标中,第k个目标的几何中心在基准镜坐标系下的坐标值;
表示U个反射目标的重心在在基准镜坐标系下的坐标值;
定义辅助坐标系1,辅助坐标系1的原点位于U个反射目标的重心,辅助坐标系1的三轴指向与星上靶标本体坐标系的三轴指向一致;(X'Ck,YC'k,Z'Ck)表示U个反射目标中,第k个目标的几何中心在辅助坐标系1下的坐标值;
定义辅助坐标系2,辅助坐标系2的原点位于U个反射目标的重心,辅助坐标系2的三轴指向与底板基准镜坐标系的三轴指向一致;(X'Jk,YJ'k,Z'Jk)表示U个反射目标中,第k个目标的几何中心在基准镜坐标系下的坐标值;
A表示U个反射目标的几何中心在辅助坐标系1下坐标值的集合;
表示第U个反射目标中第一个反射目标的几何中心在辅助坐标系1下的坐标值;
表示第U个反射目标中第二个反射目标的几何中心在辅助坐标系1下的坐标值;
表示第U个反射目标中第U个反射目标的几何中心在辅助坐标系1下的坐标值;
B表示U个反射目标的几何中心在辅助坐标系2下坐标值的集合;
表示第U个反射目标中第一个反射目标的几何中心在辅助坐标系2下的坐标值;
表示第U个反射目标中第二个反射目标的几何中心在辅助坐标系2下的坐标值;
表示第U个反射目标中第U个反射目标的几何中心在辅助坐标系2下的坐标值;
R表示星上靶标本体坐标系至基准镜坐标系的旋转矩阵;
T'表示由U个反射目标中,每个反射目标的几何中心计算得到的星上靶标本体坐标系OCXCYCZC至基准镜坐标系OJXJYJZJ的平移量。
在上述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,所述步骤(五)中,双目相机辅助坐标系OFXFYFZF的建立方法为:以左目相机基准镜几何中心到右目相机基准镜几何中心的连线方向为正YF轴;连线的中点为双目相机辅助坐标系的原点OF;相机光轴方向为正ZF轴,正XF按照右手法则确定;绕正XF轴的转动表示偏航方向,绕正YF的转动表示俯仰方向,绕正ZF轴的转动表示滚转方向。
在上述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,所述步骤(六)中,左目相机图像坐标系OLxLyL的建立方法为:左目相机图像的左上角点为左目相机图像坐标系的原点OL;左目相机图像列增大的方向为正xL方向;左目相机图像行增大的方向为正yL方向;
右目相机图像坐标系ORxRyR的建立方法为:右目相机图像的左上角点为左目相机图像坐标系的原点OR;右目相机图像列增大的方向为正xR方向;左目相机图像行增大的方向为正yR方向。
在上述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,所述步骤(七)中,Lm在2倍最佳成像距离内取值,范围内取值,θm范围内取值,κm在0°~-90°范围内取值,Fov表示左目相机、右目相机的视场。
在上述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,所述步骤(八)中,将N个反射目标的几何中心在基准镜坐标系下的坐标(XJi,YJi,ZJi)与左目相机对每个反射目标的成像位置坐标(xiLm,yiLm)一一对应,m张图像共计m*N个目标,对每个目标数据按照下式建立像点位置修正方程:
式中,Δx’iLm表示左目相机第m张图像上第i个标志成像位置在xL方向的修正量;
Δyi'Lm表示左目相机第m张图像上第i个标志成像位置在yL方向的修正量;
定义双目左目相机本体坐标系OBLXBLYBLZBL,左目相机本体坐标系OBLXBLYBLZBL是一个坐标系原点和坐标系指向待确定的空间坐标系,双目左目相机本体坐标系OBLXBLYBLZBL的原点OBL位于相机光学***光心位置,列增大方向为XBL方向,行减小方向为YBL方向,ZBL方向按照右手法则定义;(XLm,YLm,ZLm)表示第m张图像拍摄时基准镜坐标系OJXJYJZJ原点OJ在双目左目相机本体坐标系OBLXBLYBLZBL下的坐标;(XBLim,YBLim,ZBLim)表示第m张图像拍摄时第i个点在左目相机本体坐标系OBLXBLYBLZBL下的坐标;RwLmLmLmLm)表示第m张图像拍摄时,左目相机本体坐标系OBLXBLYBLZBL至基准镜坐标系OJXJYJZJ的旋转矩阵,ωLmLmLm分别为与旋转阵对应的旋转角度;
fL表示左目相机焦距;
Δxr-iLm和Δyr-iLm分别表示第m张图像上第i个标志成像位置在xL和yL方向的径向畸变修正量;
Δxd-iLm和Δyd-iLm分别表示第m张图像上第i个标志成像位置在xL和yL方向的偏心畸变修正量;
Δxm-iLm和Δym-iLm分别表示第m张图像上第i个标志成像位置xL和yL方向的像平面畸变修正量;
xpL表示左目相机图像中心在xL方向的偏移量;
ypL表示左目相机图像中心在yL方向的偏移量;
K1L表示左目相机一阶径向畸变修正系数;
K2L表示左目相机二阶径向畸变修正系数;
K3L表示左目相机三阶径向畸变修正系数;
P1L表示左目相机偏心畸变修正系数1;
P2L表示左目相机偏心畸变修正系数2;
b1L表示左目相机像平面畸变修正系数1;
b2L表示左目相机像平面畸变修正系数2;
表示第m张图像上第i个标志成像位置与(xpL,ypL)的距离;
将公式(11)至公式(17)进一步整理为如公式(18),每个点可列2个方程,m*N个点共计列方程2*m*N个:
构造迭代式采用高斯-牛顿法求解:
据此求得双目左目相机的标定参数ωLmLmLm,XLm,YLm,ZLm,fL,xpL,ypL,K1L,K2L,K3L,P1L,P2L,b1L,b2L
同理,将右目相机对星上靶标反射目标的成像位置坐标(xiRm,yiRm)与底板基准镜坐标系下的坐标(XJi,YJi,ZJi)一一对应,列2*m*N个方程,求解右目相机参数,包括:
fR表示右目相机焦距;
xpR表示右目相机图像中心在xR方向的偏移量;
ypR表示右目相机图像中心在yR方向的偏移量;
K1R表示右目相机一阶径向畸变修正系数;
K2R表示右目相机二阶径向畸变修正系数;
K3R表示右目相机三阶径向畸变修正系数;
P1R表示右目相机偏心畸变修正系数1;
P2R表示右目相机偏心畸变修正系数2;
b1R表示右目相机像平面畸变修正系数1;
b2R表示右目相机像平面畸变修正系数2;
定义双目右目相机本体坐标系OBRXBRYBRZBR,右目相机本体坐标系OBRXBRYBRZBR是一个坐标系原点和坐标系指向待确定的空间坐标系,双目右目相机本体坐标系OBRXBRYBRZBR的原点OBR位于相机光学***光心位置,列增大方向为XBR方向,行减小方向为YBR方向,ZBR方向按照右手法则定义;RwRmRmRmRm)表示第m张图像拍摄时,双目右目相机本体坐标系OBRXBRYBRZBR至基准镜坐标系OJXJYJZJ的旋转矩阵,ωRmRmRm分别为与旋转阵对应的旋转角度。
在上述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,所述步骤(九)中,双目左、右目相机之间的位置和姿态关系按照下式计算:
式中,TL=(XLm,YLm,ZLm)T,TR=(XRm,YRm,ZRm)T
Rmmmm)表示第m张图像拍摄时,左目相机本体系到右目相机本体系的旋转阵,ωmmm分别为与旋转阵对应的旋转角度;
Tm表示第m张图像拍摄时,右目相机本体系原点在左目相机本体系下坐标;
T表示右目相机本体系原点在左目相机本体系下坐标;ω表示左目相机本体系相对于右目相机本体系的俯仰角;
ψ表示左目相机本体系相对于右目相机本体系的偏航角;
γ表示左目相机本体系相对于右目相机本体系的滚转角。
在上述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,所述步骤(十)中,按照下式计算双目相机在轨标定后的精度:
式中,x'iLm和y'iLm分别表示左目相机图像上第i个目标校正后xL方向、yL方向的坐标分量;
同理,计算右目相机图像上第i个目标经过畸变校正后的坐标(xi'Rm,y'iRm);x'iRm和y'iRm分别表示右目相机图像上第i个目标校正后xR方向、yR方向的坐标分量;
表示左目相机光心到右目相机光心的单位矢量;
rzDL=[0 0 1],表示左目相机光轴方向矢量;
表示由rzDL方向和ryLv方向叉乘得到的单位矢量方向;
rzLv=rxLv×ryLv,表示由rxLv方向和ryLv方向叉乘得到矢量方向;
定义左目相机虚拟坐标系,坐标系原点位于左目相机光心位置,rxLv为正XVL方向,ryLv为正YVL方向,rzLv为正ZVL方向;
定义右目相机虚拟坐标系,坐标系原点位于右目相机光心位置,三轴方向与左目相机虚拟坐标系指向一致,三轴方向分别为XVR,YVR和ZVR
RVL2DL=[rxLvT ryLvT rzLvT],表示左目相机虚拟坐标系至左目相机本体系的旋转阵;
表示右目相机本体系至右目相机虚拟坐标系的旋转阵;
表示左目相机第m张图像上第i个标志成像位置修正后在左目相机虚拟坐标下的坐标,XimVL,YimVL,ZimVL分别为坐标在左目相机虚拟坐标XVL方向、YVL方向和ZVL方向的分量;
[XimVR YimVR ZimVR]T=RDR2VR·[x'ipRm y'ipRm-fR]T,表示右目相机第m张图像上第i个标志成像位置修正后在右目相机虚拟坐标下的坐标,XimVR,YimVR,ZimVR分别为坐标在右目相机虚拟坐标XVR方向、YVR方向和ZVR方向的分量;
(ximvl,yimvl)表示左目相机第m张图像上第i个标志成像位置修正后重投影得到像点坐标,ximvl,yimvl分别为XVL方向和YVL方向的分量;
(ximvr,yimvr)表示右目相机第m张图像上第i个标志成像位置修正后重新投影得到像点坐标,ximvr,yimvr分别为XVR方向和YVR方向的分量;
erri=yimvr-yimvl表示左目相机、右目相机第m张图像上第i个标志成像
位置修正并重新投影后像点在YVL方向的偏差量。
本发明与现有技术相比具有如下优点:
(1)本发明采用了带畸变修正的相机标定模型,提高了双目相机的在轨几何标定精度;
(2)本发明采用星上靶标用于相机在轨几何标定,使得相机参数标定基于严格的物像关系约束,保证了标定参数的可靠性;
(3)本发明通过合理规划测例,在星上空间资源有限、目标数量和分布不能充分覆盖相机视场的情况下,使得大视场双目相机的全视场、全工作距均能得到有效标定,保证了大视场双目相机全视场内的标定精度;
(4)本发明通过整体最优估计,同时求解双目相机的内、外参数,以保证相机参数的估计值能够使单个相机的物像共线关系、双相机之间的空间约束关系同时达到最优;
(5)方法利用双目相机测量的空间几何约束关系验证在轨校正精度,使得在轨精度验证不依赖于目标的绝对位置数据。
附图说明
图1为本发明在轨几何校正及精度验证流程示意图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步详细的描述:
如图1所示为在轨几何校正及精度验证流程示意图,由图可知,大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:包括如下步骤:
步骤(一)、利用摄影测量相机对星上靶标上的N个反射目标进行空间位置测量,测量N个反射目标的几何中心在星上靶标本体坐标系OCXCYCZC下的位置,设第i个反射目标的坐标值为(XCi,YCi,ZCi);XCi,YCi,ZCi分别为第i个反射目标在星上靶标本体坐标系XC方向、YC方向和ZC方向的坐标分量;N为大于等于100的正整数;1≤i≤N,且i为正整数;其中,星上靶标本体坐标系OCXCYCZC的建立方法为:以星上靶标中心标志的位置为星上靶标本体坐标系原点OC,中心标志与其右侧标志的连线为正XC方向,中心标志与其上方标志连线与正XC方向叉乘后的方向为正ZC方向,正YC方向按照右手法则确定。
步骤(二)、在星上靶标上方10cm位置处安装基准镜;架设第一经纬仪A1、第二经纬仪A2和第三经纬仪A3,利用第一经纬仪A1、第二经纬仪A2和第三经纬仪A3准直建立基准镜坐标系OJXJYJZJ;其中,第一经纬仪A1、第二经纬仪A2和第三经纬仪A3的架设方法为:沿基准镜的前端面法线方向架设第一经纬仪A1,第一经纬仪A1距基准镜的距离不小于1m;沿基准镜的侧端面法线方向架设第二经纬仪A2,第二经纬仪A2距基准镜的距离不小于1m;第三经纬仪A3位于与第一经纬仪A1的左侧,且对星上靶标的观测夹角不小于60°。基准镜坐标系OJXJYJZJ的建立方法为:以基准镜的几何中心为坐标系原点OJ,基准镜前端面法线指向基准镜安装面的方向为正ZJ方向;基准镜侧端面法线指向星上靶标的方向为正YJ方向;正ZJ按照右手法则定义。
步骤(三)、从N个反射目标中选取U个目标,利用第一经纬仪A1和第三经纬仪A3测量U个目标的几何中心在基准镜坐标系下的位置;设第k个反射目标在基准镜坐标系的坐标值为(XJK,YJK,ZJK);其中,XJK,YJK,ZJK分别为第k个反射目标在基准镜坐标系XJ方向、YJ方向和ZJ方向的坐标分量;10≤U≤N,且U为正整数;1≤k≤U,且k为正整数;
步骤(四)、根据步骤(一)和步骤(三)获得的数据,计算星上靶标N个反射目标的几何中心在基准镜坐标系下OJXJYJZJ的坐标值(XJi,YJi,ZJi);XJi,YJi,ZJi分别为第i个反射目标在基准镜坐标系XJ方向、YJ方向和ZJ方向的坐标分量;
第i个反射目标的几何中心在基准镜坐标系下的坐标值(XJi,YJi,ZJi)的计算方法为:
R=(A·BT)·(B·BT)-1 (7)
式中,(XCk,YCk,ZCk)表示U个反射目标中,第k个目标的几何中心在星上靶标本体坐标系下的坐标值;
表示U个反射目标的重心在星上靶标本体坐标系下的坐标值;
(XJk,YJk,ZJk)表示U个反射目标中,第k个目标的几何中心在基准镜坐标系下的坐标值;
表示U个反射目标的重心在在基准镜坐标系下的坐标值;
定义辅助坐标系1,辅助坐标系1的原点位于U个反射目标的重心,辅助坐标系1的三轴指向与星上靶标本体坐标系的三轴指向一致;(X'Ck,Y'Ck,Z'Ck)表示U个反射目标中,第k个目标的几何中心在辅助坐标系1下的坐标值;
定义辅助坐标系2,辅助坐标系2的原点位于U个反射目标的重心,辅助坐标系2的三轴指向与底板基准镜坐标系的三轴指向一致;(X'Jk,Y'Jk,Z'Jk)表示U个反射目标中,第k个目标的几何中心在基准镜坐标系下的坐标值;
A表示U个反射目标的几何中心在辅助坐标系1下坐标值的集合;
表示第U个反射目标中第一个反射目标的几何中心在辅助坐标系1下的坐标值;
表示第U个反射目标中第二个反射目标的几何中心在辅助坐标系1下的坐标值;
表示第U个反射目标中第U个反射目标的几何中心在辅助坐标系1下的坐标值;
B表示U个反射目标的几何中心在辅助坐标系2下坐标值的集合;
表示第U个反射目标中第一个反射目标的几何中心在辅助坐标系2下的坐标值;
表示第U个反射目标中第二个反射目标的几何中心在辅助坐标系2下的坐标值;
表示第U个反射目标中第U个反射目标的几何中心在辅助坐标系2下的坐标值;
R表示星上靶标本体坐标系至基准镜坐标系的旋转矩阵;
T'表示由U个反射目标中,每个反射目标的几何中心计算得到的星上靶标本体坐标系OCXCYCZC至基准镜坐标系OJXJYJZJ的平移量。
步骤(五)、建立双目相机辅助坐标系OFXFYFZF;调整双目相机,实现双目相机辅助坐标系OFXFYFZF相对于基准镜坐标系OJXJYJZJ的角度为相对位置为(0,0,L1);其中,θ1,κ1分别表示双目相机第一次调整到位时,双目相机辅助坐标系OFXFYFZF相对于基准镜坐标系OJXJYJZJ的俯仰角、偏航角和滚转角;L1表示双目相机辅助坐标系的原点在基准镜坐标系下正ZJ方向的坐标分量;
其中,双目相机辅助坐标系OFXFYFZF的建立方法为:以左目相机基准镜几何中心到右目相机基准镜几何中心的连线方向为正YF轴;连线的中点为双目相机辅助坐标系的原点OF;相机光轴方向为正ZF轴,正XF按照右手法则确定;绕正XF轴的转动表示偏航方向,绕正YF的转动表示俯仰方向,绕正ZF轴的转动表示滚转方向。
步骤(六)、双目相机第一次调整到指定位置后,建立左目相机图像坐标系OLxLyL和右目相机图像坐标系ORxRyR;对星上靶标上的反射目标成像;左目相机的成像图像为PL1;右目相机的成像图像为PR1;测量N个反射目标分别在左、右目相机图像坐标系下的成像位置(xiL1,yiL1)和(xiR1,yiR1);xiL1,yiL1分别表示第i个反射目标在左目相机第1张图像的左目相机图像坐标系OLxLyL下xL和yL方向的坐标分量;xiR1,yiR1分别表示第i个反射目标在右目相机第1张图像的右目相机图像坐标系ORxRyR下xR和yR方向的坐标分量;
左目相机图像坐标系OLxLyL的建立方法为:左目相机图像的左上角点为左目相机图像坐标系的原点OL;左目相机图像列增大的方向为正xL方向;左目相机图像行增大的方向为正yL方向;
右目相机图像坐标系ORxRyR的建立方法为:右目相机图像的左上角点为左目相机图像坐标系的原点OR;右目相机图像列增大的方向为正xR方向;左目相机图像行增大的方向为正yR方向。
步骤(七)、重复步骤(五)和步骤(六),对双目相机进行m次调整,10≤m≤N;双目相机辅助坐标系OFXFYFZF相对于基准镜坐标系OJXJYJZJ的角度为相对位置为(0,0,Lm);θm,κm分别表示机械臂第m次调整到位时,双目相机辅助坐标系OFXFYFZF相对基准镜坐标系OJXJYJZJ的俯仰角、偏航角和滚转角,Lm表示双目相机辅助坐标系OFXFYFZF原点在基准镜坐标系OJXJYJZJ下ZJ方向的坐标分量;PLm表示左目相机拍摄的第m张图像;PRm表示右目相机拍摄的第m张图像;测量N个反射目标分别在左、右目相机图像坐标系下的成像位置(xiLm,yiLm)和(xiRm,yiRm);xiLm,yiLm分别表示第i个反射目标在左目相机第m张图像的左目相机图像坐标系OLxLyL下xL和yL方向的坐标分量;xiRm,yiRm分别表示第i个反射目标在右目相机第m张图像的右目相机图像坐标系ORxRyR下xR和yR方向的坐标分量;其中,Lm在2倍最佳成像距离内取值,范围内取值,θm范围内取值,κm在0°~-90°范围内取值,Fov表示左目相机、右目相机的视场。
步骤(八)、将步骤(四)和步骤(七)的测量数据一一对应,分别建立左目相机和右目相机的反射目标像点位置的修正方程;并计算左目相机内参数、左目相机拍摄图像时的摄站外参数,以及右目相机内参数、右目相机拍摄图像时的摄站外参数;
将N个反射目标的几何中心在基准镜坐标系下的坐标(XJi,YJi,ZJi)与左目相机对每个反射目标的成像位置坐标(xiLm,yiLm)一一对应,m张图像共计m*N个目标,对每个目标数据按照下式建立像点位置修正方程:
式中,Δx'iLm表示左目相机第m张图像上第i个标志成像位置在xL方向的修正量;
Δy'iLm表示左目相机第m张图像上第i个标志成像位置在yL方向的修正量;
定义双目左目相机本体坐标系OBLXBLYBLZBL,左目相机本体坐标系OBLXBLYBLZBL是一个坐标系原点和坐标系指向待确定的空间坐标系,双目左目相机本体坐标系OBLXBLYBLZBL的原点OBL位于相机光学***光心位置,列增大方向为XBL方向,行减小方向为YBL方向,ZBL方向按照右手法则定义;(XLm,YLm,ZLm)表示第m张图像拍摄时基准镜坐标系OJXJYJZJ原点OJ在双目左目相机本体坐标系OBLXBLYBLZBL下的坐标;(XBLim,YBLim,ZBLim)表示第m张图像拍摄时第i个点在左目相机本体坐标系OBLXBLYBLZBL下的坐标;RwLmLmLmLm)表示第m张图像拍摄时,左目相机本体坐标系OBLXBLYBLZBL至基准镜坐标系OJXJYJZJ的旋转矩阵,ωLmLmLm分别为与旋转阵对应的旋转角度;
fL表示左目相机焦距;
Δxr-iLm和Δyr-iLm分别表示第m张图像上第i个标志成像位置在xL和yL方向的径向畸变修正量;
Δxd-iLm和Δyd-iLm分别表示第m张图像上第i个标志成像位置在xL和yL方向的偏心畸变修正量;
Δxm-iLm和Δym-iLm分别表示第m张图像上第i个标志成像位置xL和yL方向的像平面畸变修正量;
xpL表示左目相机图像中心在xL方向的偏移量;
ypL表示左目相机图像中心在yL方向的偏移量;
K1L表示左目相机一阶径向畸变修正系数;
K2L表示左目相机二阶径向畸变修正系数;
K3L表示左目相机三阶径向畸变修正系数;
P1L表示左目相机偏心畸变修正系数1;
P2L表示左目相机偏心畸变修正系数2;
b1L表示左目相机像平面畸变修正系数1;
b2L表示左目相机像平面畸变修正系数2;
表示第m张图像上第i个标志成像位置与(xpL,ypL)的距离;
将公式(11)至公式(17)进一步整理为如公式(18),每个点可列2个方程,m*N个点共计列方程2*m*N个:
构造迭代式采用高斯-牛顿法求解:
据此求得双目左目相机的标定参数ωLmLmLm,XLm,YLm,ZLm,fL,xpL,ypL,K1L,K2L,K3L,P1L,P2L,b1L,b2L
同理,将右目相机对星上靶标反射目标的成像位置坐标(xiRm,yiRm)与底板基准镜坐标系下的坐标(XJi,YJi,ZJi)一一对应,列2*m*N个方程,求解右目相机参数,包括:
fR表示右目相机焦距;
xpR表示右目相机图像中心在xR方向的偏移量;
ypR表示右目相机图像中心在yR方向的偏移量;
K1R表示右目相机一阶径向畸变修正系数;
K2R表示右目相机二阶径向畸变修正系数;
K3R表示右目相机三阶径向畸变修正系数;
P1R表示右目相机偏心畸变修正系数1;
P2R表示右目相机偏心畸变修正系数2;
b1R表示右目相机像平面畸变修正系数1;
b2R表示右目相机像平面畸变修正系数2;
定义双目右目相机本体坐标系OBRXBRYBRZBR,右目相机本体坐标系OBRXBRYBRZBR是一个坐标系原点和坐标系指向待确定的空间坐标系,双目右目相机本体坐标系OBRXBRYBRZBR的原点OBR位于相机光学***光心位置,列增大方向为XBR方向,行减小方向为YBR方向,ZBR方向按照右手法则定义;RwRmRmRmRm)表示第m张图像拍摄时,双目右目相机本体坐标系OBRXBRYBRZBR至基准镜坐标系OJXJYJZJ的旋转矩阵,ωRmRmRm分别为与旋转阵对应的旋转角度。
步骤(九)、根据步骤(八)计算得到的左目相机摄站外参数和右目相机摄站外参数计算左、右目相机之间的位置和姿态;
双目左、右目相机之间的位置和姿态关系按照下式计算:
式中,TL=(XLm,YLm,ZLm)T,TR=(XRm,YRm,ZRm)T
Rmmmm)表示第m张图像拍摄时,左目相机本体系到右目相机本体系的旋转阵,ωmmm分别为与旋转阵对应的旋转角度;
Tm表示第m张图像拍摄时,右目相机本体系原点在左目相机本体系下坐标;
T表示右目相机本体系原点在左目相机本体系下坐标;ω表示左目相机本体系相对于右目相机本体系的俯仰角;
ψ表示左目相机本体系相对于右目相机本体系的偏航角;
γ表示左目相机本体系相对于右目相机本体系的滚转角。
步骤(十)、从m对图像中任选一张,根据步骤(八)和步骤(九)计算的左目相机内参数、外参数,以及左、右目相机之间的位置和姿态计算双目相机在轨标定后的精度。
按照下式计算双目相机在轨标定后的精度:
式中,xi'Lm和yi'Lm分别表示左目相机图像上第i个目标校正后xL方向、yL方向的坐标分量;
同理,计算右目相机图像上第i个目标经过畸变校正后的坐标(xi'Rm,yi'Rm);xi'Rm和yi'Rm分别表示右目相机图像上第i个目标校正后xR方向、yR方向的坐标分量;
表示左目相机光心到右目相机光心的单位矢量;
rzDL=[0 0 1],表示左目相机光轴方向矢量;
表示由rzDL方向和ryLv方向叉乘得到的单位矢量方向;
rzLv=rxLv×ryLv,表示由rxLv方向和ryLv方向叉乘得到矢量方向;
定义左目相机虚拟坐标系,坐标系原点位于左目相机光心位置,rxLv为正XVL方向,ryLv为正YVL方向,rzLv为正ZVL方向;
定义右目相机虚拟坐标系,坐标系原点位于右目相机光心位置,三轴方向与左目相机虚拟坐标系指向一致,三轴方向分别为XVR,YVR和ZVR
RVL2DL=[rxLvT ryLvT rzLvT],表示左目相机虚拟坐标系至左目相机本体系的旋转阵;
表示右目相机本体系至右目相机虚拟坐标系的旋转阵;
表示左目相机第m张图像上第i个标志成像位置修正后在左目相机虚拟坐标下的坐标,XimVL,YimVL,ZimVL分别为坐标在左目相机虚拟坐标XVL方向、YVL方向和ZVL方向的分量;
[XimVR YimVR ZimVR]T=RDR2VR·[x'ipRm y'ipRm -fR]T,表示右目相机第m张图像上第i个标志成像位置修正后在右目相机虚拟坐标下的坐标,XimVR,YimVR,ZimVR分别为坐标在右目相机虚拟坐标XVR方向、YVR方向和ZVR方向的分量;
(ximvl,yimvl)表示左目相机第m张图像上第i个标志成像位置修正后重投影得到像点坐标,ximvl,yimvl分别为XVL方向和YVL方向的分量;
(ximvr,yimvr)表示右目相机第m张图像上第i个标志成像位置修正后重新投影得到像点坐标,ximvr,yimvr分别为XVR方向和YVR方向的分量;
erri=yimvr-yimvl表示左目相机、右目相机第m张图像上第i个标志成像位置修正并重新投影后像点在YVL方向的偏差量。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。

Claims (11)

1.大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:包括如下步骤:
步骤(一)、利用摄影测量相机对星上靶标上的N个反射目标进行空间位置测量,测量N个反射目标的几何中心在星上靶标本体坐标系OCXCYCZC下的位置,设第i个反射目标的坐标值为(XCi,YCi,ZCi);XCi,YCi,ZCi分别为第i个反射目标在星上靶标本体坐标系XC方向、YC方向和ZC方向的坐标分量;N为大于等于100的正整数;1≤i≤N,且i为正整数;
步骤(二)、在星上靶标上方10cm位置处安装基准镜;架设第一经纬仪A1、第二经纬仪A2和第三经纬仪A3,利用第一经纬仪A1、第二经纬仪A2和第三经纬仪A3准直建立基准镜坐标系OJXJYJZJ
步骤(三)、从N个反射目标中选取U个目标,利用第一经纬仪A1和第三经纬仪A3测量U个目标的几何中心在基准镜坐标系下的位置;设第k个反射目标在基准镜坐标系的坐标值为(XJK,YJK,ZJK);其中,XJK,YJK,ZJK分别为第k个反射目标在基准镜坐标系XJ方向、YJ方向和ZJ方向的坐标分量;10≤U≤N,且U为正整数;1≤k≤U,且k为正整数;
步骤(四)、根据步骤(一)和步骤(三)获得的数据,计算星上靶标N个反射目标的几何中心在基准镜坐标系下OJXJYJZJ的坐标值(XJi,YJi,ZJi);XJi,YJi,ZJi分别为第i个反射目标在基准镜坐标系XJ方向、YJ方向和ZJ方向的坐标分量;
步骤(五)、建立双目相机辅助坐标系OFXFYFZF;调整双目相机,实现双目相机辅助坐标系OFXFYFZF相对于基准镜坐标系OJXJYJZJ的角度为相对位置为(0,0,L1);其中,θ1,κ1分别表示双目相机第一次调整到位时,双目相机辅助坐标系OFXFYFZF相对于基准镜坐标系OJXJYJZJ的俯仰角、偏航角和滚转角;L1表示双目相机辅助坐标系的原点在基准镜坐标系下正ZJ方向的坐标分量;
步骤(六)、双目相机第一次调整到指定位置后,建立左目相机图像坐标系OLxLyL和右目相机图像坐标系ORxRyR;对星上靶标上的反射目标成像;左目相机的成像图像为PL1;右目相机的成像图像为PR1;测量N个反射目标分别在左、右目相机图像坐标系下的成像位置(xiL1,yiL1)和(xiR1,yiR1);xiL1,yiL1分别表示第i个反射目标在左目相机第1张图像的左目相机图像坐标系OLxLyL下xL和yL方向的坐标分量;xiR1,yiR1分别表示第i个反射目标在右目相机第1张图像的右目相机图像坐标系ORxRyR下xR和yR方向的坐标分量;
步骤(七)、重复步骤(五)和步骤(六),对双目相机进行m次调整,10≤m≤N;双目相机辅助坐标系OFXFYFZF相对于基准镜坐标系OJXJYJZJ的角度为相对位置为(0,0,Lm);θm,κm分别表示机械臂第m次调整到位时,双目相机辅助坐标系OFXFYFZF相对基准镜坐标系OJXJYJZJ的俯仰角、偏航角和滚转角,Lm表示双目相机辅助坐标系OFXFYFZF原点在基准镜坐标系OJXJYJZJ下ZJ方向的坐标分量;PLm表示左目相机拍摄的第m张图像;PRm表示右目相机拍摄的第m张图像;测量N个反射目标分别在左、右目相机图像坐标系下的成像位置(xiLm,yiLm)和(xiRm,yiRm);xiLm,yiLm分别表示第i个反射目标在左目相机第m张图像的左目相机图像坐标系OLxLyL下xL和yL方向的坐标分量;xiRm,yiRm分别表示第i个反射目标在右目相机第m张图像的右目相机图像坐标系ORxRyR下xR和yR方向的坐标分量;
步骤(八)、将步骤(四)和步骤(七)的测量数据一一对应,分别建立左目相机和右目相机的反射目标像点位置的修正方程;并计算左目相机内参数、左目相机拍摄图像时的摄站外参数,以及右目相机内参数、右目相机拍摄图像时的摄站外参数;
步骤(九)、根据步骤(八)计算得到的左目相机摄站外参数和右目相机摄站外参数计算左、右目相机之间的位置和姿态;
步骤(十)、从m对图像中任选一张,根据步骤(八)和步骤(九)计算的左目相机内参数、外参数,以及左、右目相机之间的位置和姿态计算双目相机在轨标定后的精度。
2.根据权利要求1所述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:所述步骤(一)中,星上靶标本体坐标系OCXCYCZC的建立方法为:以星上靶标中心标志的位置为星上靶标本体坐标系原点OC,中心标志与其右侧标志的连线为正XC方向,中心标志与其上方标志连线与正XC方向叉乘后的方向为正ZC方向,正YC方向按照右手法则确定。
3.根据权利要求1所述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:所述步骤(二)中,第一经纬仪A1、第二经纬仪A2和第三经纬仪A3的架设方法为:沿基准镜的前端面法线方向架设第一经纬仪A1,第一经纬仪A1距基准镜的距离不小于1m;沿基准镜的侧端面法线方向架设第二经纬仪A2,第二经纬仪A2距基准镜的距离不小于1m;第三经纬仪A3位于与第一经纬仪A1的左侧,且对星上靶标的观测夹角不小于60°。
4.根据权利要求3所述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:所述步骤(二)中,基准镜坐标系OJXJYJZJ的建立方法为:以基准镜的几何中心为坐标系原点OJ,基准镜前端面法线指向基准镜安装面的方向为正ZJ方向;基准镜侧端面法线指向星上靶标的方向为正YJ方向;正ZJ按照右手法则定义。
5.根据权利要求1所述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:所述步骤(四)中,第i个反射目标的几何中心在基准镜坐标系下的坐标值(XJi,YJi,ZJi)的计算方法为:
<mrow> <msub> <mover> <mi>X</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>C</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mi>U</mi> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>U</mi> </munderover> <msub> <mi>X</mi> <mrow> <mi>C</mi> <mi>k</mi> </mrow> </msub> <mo>,</mo> <msub> <mover> <mi>Y</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>C</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mi>U</mi> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>U</mi> </munderover> <msub> <mi>Y</mi> <mrow> <mi>C</mi> <mi>k</mi> </mrow> </msub> <mo>,</mo> <msub> <mover> <mi>Z</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>C</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mi>U</mi> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>U</mi> </munderover> <msub> <mi>Z</mi> <mrow> <mi>C</mi> <mi>k</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mover> <mi>X</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>J</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mi>U</mi> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>U</mi> </munderover> <msub> <mi>X</mi> <mrow> <mi>J</mi> <mi>k</mi> </mrow> </msub> <mo>,</mo> <msub> <mover> <mi>Y</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>J</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mi>U</mi> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>U</mi> </munderover> <msub> <mi>Y</mi> <mrow> <mi>J</mi> <mi>k</mi> </mrow> </msub> <mo>,</mo> <msub> <mover> <mi>Z</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>J</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mi>U</mi> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>U</mi> </munderover> <msub> <mi>Z</mi> <mrow> <mi>J</mi> <mi>k</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msubsup> <mi>X</mi> <mrow> <mi>C</mi> <mi>k</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>Y</mi> <mrow> <mi>C</mi> <mi>k</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>Z</mi> <mrow> <mi>C</mi> <mi>k</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mrow> <mi>C</mi> <mi>k</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mrow> <mi>C</mi> <mi>k</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mrow> <mi>C</mi> <mi>k</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mover> <mi>X</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>C</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mover> <mi>Y</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>C</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mover> <mi>Z</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>C</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msubsup> <mi>X</mi> <mrow> <mi>J</mi> <mi>k</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>Y</mi> <mrow> <mi>J</mi> <mi>k</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>Z</mi> <mrow> <mi>J</mi> <mi>k</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mrow> <mi>J</mi> <mi>k</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mrow> <mi>J</mi> <mi>k</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mrow> <mi>J</mi> <mi>k</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mover> <mi>X</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>J</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mover> <mi>Y</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>J</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mover> <mi>Z</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>J</mi> <mi>k</mi> <mi>G</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>A</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msubsup> <mi>X</mi> <mrow> <mi>J</mi> <mn>1</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>X</mi> <mrow> <mi>J</mi> <mn>2</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <mn>...</mn> </mtd> <mtd> <msubsup> <mi>X</mi> <mrow> <mi>J</mi> <mi>U</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>Y</mi> <mrow> <mi>J</mi> <mn>1</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>Y</mi> <mrow> <mi>J</mi> <mn>2</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <mn>...</mn> </mtd> <mtd> <msubsup> <mi>Y</mi> <mrow> <mi>J</mi> <mi>U</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>Z</mi> <mrow> <mi>J</mi> <mn>1</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>Z</mi> <mrow> <mi>J</mi> <mn>2</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <mn>...</mn> </mtd> <mtd> <msubsup> <mi>Z</mi> <mrow> <mi>J</mi> <mi>U</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>B</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msubsup> <mi>X</mi> <mrow> <mi>C</mi> <mn>1</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>X</mi> <mrow> <mi>C</mi> <mn>2</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <mn>...</mn> </mtd> <mtd> <msubsup> <mi>X</mi> <mrow> <mi>C</mi> <mi>U</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>Y</mi> <mrow> <mi>C</mi> <mn>1</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>Y</mi> <mrow> <mi>C</mi> <mn>2</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <mn>...</mn> </mtd> <mtd> <msubsup> <mi>Y</mi> <mrow> <mi>C</mi> <mi>U</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>Z</mi> <mrow> <mi>C</mi> <mn>1</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <msubsup> <mi>Z</mi> <mrow> <mi>C</mi> <mn>2</mn> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> <mtd> <mn>...</mn> </mtd> <mtd> <msubsup> <mi>Z</mi> <mrow> <mi>C</mi> <mi>U</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
R=(A·BT)·(B·BT)-1 (7)
<mrow> <msup> <mi>T</mi> <mo>&amp;prime;</mo> </msup> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mrow> <mi>J</mi> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>X</mi> <mrow> <mi>J</mi> <mn>2</mn> </mrow> </msub> </mtd> <mtd> <mo>...</mo> </mtd> <mtd> <msub> <mi>X</mi> <mrow> <mi>J</mi> <mi>U</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mrow> <mi>J</mi> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>Y</mi> <mrow> <mi>J</mi> <mn>2</mn> </mrow> </msub> </mtd> <mtd> <mo>...</mo> </mtd> <mtd> <msub> <mi>Y</mi> <mrow> <mi>J</mi> <mi>U</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mrow> <mi>J</mi> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>Z</mi> <mrow> <mi>J</mi> <mn>2</mn> </mrow> </msub> </mtd> <mtd> <mo>...</mo> </mtd> <mtd> <msub> <mi>Z</mi> <mrow> <mi>J</mi> <mi>U</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mi>R</mi> <mo>&amp;CenterDot;</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mrow> <mi>C</mi> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>X</mi> <mrow> <mi>C</mi> <mn>2</mn> </mrow> </msub> </mtd> <mtd> <mo>...</mo> </mtd> <mtd> <msub> <mi>X</mi> <mrow> <mi>C</mi> <mi>U</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mrow> <mi>C</mi> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>Y</mi> <mrow> <mi>C</mi> <mn>2</mn> </mrow> </msub> </mtd> <mtd> <mo>...</mo> </mtd> <mtd> <msub> <mi>Y</mi> <mrow> <mi>C</mi> <mi>U</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mrow> <mi>C</mi> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>Z</mi> <mrow> <mi>C</mi> <mn>2</mn> </mrow> </msub> </mtd> <mtd> <mo>...</mo> </mtd> <mtd> <msub> <mi>Z</mi> <mrow> <mi>C</mi> <mi>U</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>T</mi> <mo>=</mo> <mfrac> <mn>1</mn> <mi>U</mi> </mfrac> <mo>&amp;CenterDot;</mo> <msup> <mi>T</mi> <mo>&amp;prime;</mo> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mrow> <mi>J</mi> <mi>i</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mrow> <mi>J</mi> <mi>i</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mrow> <mi>J</mi> <mi>i</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mi>R</mi> <mo>&amp;CenterDot;</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mrow> <mi>C</mi> <mi>i</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mrow> <mi>C</mi> <mi>i</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mrow> <mi>C</mi> <mi>i</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mi>T</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>
式中,(XCk,YCk,ZCk)表示U个反射目标中,第k个目标的几何中心在星上靶标本体坐标系下的坐标值;
表示U个反射目标的重心在星上靶标本体坐标系下的坐标值;
(XJk,YJk,ZJk)表示U个反射目标中,第k个目标的几何中心在基准镜坐标系下的坐标值;
表示U个反射目标的重心在在基准镜坐标系下的坐标值;
定义辅助坐标系1,辅助坐标系1的原点位于U个反射目标的重心,辅助坐标系1的三轴指向与星上靶标本体坐标系的三轴指向一致;(X'Ck,Y′Ck,Z'Ck)表示U个反射目标中,第k个目标的几何中心在辅助坐标系1下的坐标值;
定义辅助坐标系2,辅助坐标系2的原点位于U个反射目标的重心,辅助坐标系2的三轴指向与底板基准镜坐标系的三轴指向一致;(X'Jk,Y′Jk,Z'Jk)表示U个反射目标中,第k个目标的几何中心在基准镜坐标系下的坐标值;
A表示U个反射目标的几何中心在辅助坐标系1下坐标值的集合;
表示第U个反射目标中第一个反射目标的几何中心在辅助坐标系1下的坐标值;
表示第U个反射目标中第二个反射目标的几何中心在辅助坐标系1下的坐标值;
表示第U个反射目标中第U个反射目标的几何中心在辅助坐标系1下的坐标值;
B表示U个反射目标的几何中心在辅助坐标系2下坐标值的集合;
表示第U个反射目标中第一个反射目标的几何中心在辅助坐标系2下的坐标值;
表示第U个反射目标中第二个反射目标的几何中心在辅助坐标系2下的坐标值;
表示第U个反射目标中第U个反射目标的几何中心在辅助坐标系2下的坐标值;
R表示星上靶标本体坐标系至基准镜坐标系的旋转矩阵;
T'表示由U个反射目标中,每个反射目标的几何中心计算得到的星上靶标本体坐标系OCXCYCZC至基准镜坐标系OJXJYJZJ的平移量。
6.根据权利要求1所述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:所述步骤(五)中,双目相机辅助坐标系OFXFYFZF的建立方法为:以左目相机基准镜几何中心到右目相机基准镜几何中心的连线方向为正YF轴;连线的中点为双目相机辅助坐标系的原点OF;相机光轴方向为正ZF轴,正XF按照右手法则确定;绕正XF轴的转动表示偏航方向,绕正YF的转动表示俯仰方向,绕正ZF轴的转动表示滚转方向。
7.根据权利要求1所述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:所述步骤(六)中,左目相机图像坐标系OLxLyL的建立方法为:左目相机图像的左上角点为左目相机图像坐标系的原点OL;左目相机图像列增大的方向为正xL方向;左目相机图像行增大的方向为正yL方向;
右目相机图像坐标系ORxRyR的建立方法为:右目相机图像的左上角点为左目相机图像坐标系的原点OR;右目相机图像列增大的方向为正xR方向;左目相机图像行增大的方向为正yR方向。
8.根据权利要求1所述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:所述步骤(七)中,Lm在2倍最佳成像距离内取值,范围内取值,θm范围内取值,κm在0°~-90°范围内取值,Fov表示左目相机、右目相机的视场。
9.根据权利要求1所述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:所述步骤(八)中,将N个反射目标的几何中心在基准镜坐标系下的坐标(XJi,YJi,ZJi)与左目相机对每个反射目标的成像位置坐标(xiLm,yiLm)一一对应,m张图像共计m*N个目标,对每个目标数据按照下式建立像点位置修正方程:
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msubsup> <mi>&amp;Delta;x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <mo>-</mo> <msub> <mi>f</mi> <mi>L</mi> </msub> <mfrac> <msub> <mi>X</mi> <mrow> <mi>B</mi> <mi>L</mi> <mi>i</mi> <mi>m</mi> </mrow> </msub> <msub> <mi>Z</mi> <mrow> <mi>B</mi> <mi>L</mi> <mi>i</mi> <mi>m</mi> </mrow> </msub> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msubsup> <mi>&amp;Delta;y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <mo>-</mo> <msub> <mi>f</mi> <mi>L</mi> </msub> <mfrac> <msub> <mi>Y</mi> <mrow> <mi>B</mi> <mi>L</mi> <mi>i</mi> <mi>m</mi> </mrow> </msub> <msub> <mi>Z</mi> <mrow> <mi>B</mi> <mi>L</mi> <mi>i</mi> <mi>m</mi> </mrow> </msub> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mrow> <mi>B</mi> <mi>L</mi> <mi>i</mi> <mi>m</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mrow> <mi>B</mi> <mi>L</mi> <mi>i</mi> <mi>m</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mrow> <mi>B</mi> <mi>L</mi> <mi>i</mi> <mi>m</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mi>R</mi> <mi>w</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;omega;</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>&amp;psi;</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>&amp;gamma;</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>&amp;CenterDot;</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>X</mi> <mrow> <mi>J</mi> <mi>i</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>X</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>Y</mi> <mrow> <mi>J</mi> <mi>i</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Y</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>Z</mi> <mrow> <mi>J</mi> <mi>i</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>Z</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>12</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msubsup> <mi>&amp;Delta;x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <msub> <mi>&amp;Delta;x</mi> <mrow> <mi>r</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>&amp;Delta;x</mi> <mrow> <mi>d</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>&amp;Delta;x</mi> <mrow> <mi>m</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>xp</mi> <mi>L</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>&amp;Delta;y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <msub> <mi>&amp;Delta;y</mi> <mrow> <mi>r</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>&amp;Delta;y</mi> <mrow> <mi>d</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>&amp;Delta;y</mi> <mrow> <mi>m</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>yp</mi> <mi>L</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>13</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;x</mi> <mrow> <mi>r</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>K</mi> <mrow> <mn>1</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mn>2</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>4</mn> </msubsup> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mn>3</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>6</mn> </msubsup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;y</mi> <mrow> <mi>r</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>K</mi> <mrow> <mn>1</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mn>2</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>4</mn> </msubsup> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mn>3</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>6</mn> </msubsup> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>14</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;x</mi> <mi>d</mi> </msub> <mo>=</mo> <msub> <mi>P</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>+</mo> <mn>2</mn> <msubsup> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> <mo>+</mo> <mn>2</mn> <msub> <mi>P</mi> <mn>2</mn> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;y</mi> <mi>d</mi> </msub> <mo>=</mo> <msub> <mi>P</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>+</mo> <mn>2</mn> <msubsup> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> <mo>+</mo> <mn>2</mn> <msub> <mi>P</mi> <mn>1</mn> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mo>{</mo> <mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;x</mi> <mi>m</mi> </msub> <mo>=</mo> <msub> <mi>b</mi> <mn>1</mn> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>b</mi> <mn>2</mn> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;y</mi> <mi>m</mi> </msub> <mo>=</mo> <mn>0</mn> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> </mrow> <mrow> <mo>(</mo> <mn>16</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>p</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>xp</mi> <mi>L</mi> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>yp</mi> <mi>L</mi> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>17</mn> <mo>)</mo> </mrow> </mrow>
式中,Δx′iLm表示左目相机第m张图像上第i个标志成像位置在xL方向的修正量;
Δy′iLm表示左目相机第m张图像上第i个标志成像位置在yL方向的修正量;
定义双目左目相机本体坐标系OBLXBLYBLZBL,左目相机本体坐标系OBLXBLYBLZBL是一个坐标系原点和坐标系指向待确定的空间坐标系,双目左目相机本体坐标系OBLXBLYBLZBL的原点OBL位于相机光学***光心位置,列增大方向为XBL方向,行减小方向为YBL方向,ZBL方向按照右手法则定义;(XLm,YLm,ZLm)表示第m张图像拍摄时基准镜坐标系OJXJYJZJ原点OJ在双目左目相机本体坐标系OBLXBLYBLZBL下的坐标;(XBLim,YBLim,ZBLim)表示第m张图像拍摄时第i个点在左目相机本体坐标系OBLXBLYBLZBL下的坐标;RwLmLmLmLm)表示第m张图像拍摄时,左目相机本体坐标系OBLXBLYBLZBL至基准镜坐标系OJXJYJZJ的旋转矩阵,ωLmLmLm分别为与旋转阵对应的旋转角度;
fL表示左目相机焦距;
Δxr-iLm和Δyr-iLm分别表示第m张图像上第i个标志成像位置在xL和yL方向的径向畸变修正量;
Δxd-iLm和Δyd-iLm分别表示第m张图像上第i个标志成像位置在xL和yL方向的偏心畸变修正量;
Δxm-iLm和Δym-iLm分别表示第m张图像上第i个标志成像位置xL和yL方向的像平面畸变修正量;
xpL表示左目相机图像中心在xL方向的偏移量;
ypL表示左目相机图像中心在yL方向的偏移量;
K1L表示左目相机一阶径向畸变修正系数;
K2L表示左目相机二阶径向畸变修正系数;
K3L表示左目相机三阶径向畸变修正系数;
P1L表示左目相机偏心畸变修正系数1;
P2L表示左目相机偏心畸变修正系数2;
b1L表示左目相机像平面畸变修正系数1;
b2L表示左目相机像平面畸变修正系数2;
表示第m张图像上第i个标志成像位置与(xpL,ypL)的距离;
将公式(11)至公式(17)进一步整理为如公式(18),每个点可列2个方程,m*N个点共计列方程2*m*N个:
<mrow> <mi>F</mi> <mrow> <mo>(</mo> <mi>P</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>F</mi> <msub> <mn>1</mn> <mrow> <mi>i</mi> <mi>L</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <mi>F</mi> <msub> <mn>2</mn> <mrow> <mi>i</mi> <mi>L</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>F</mi> <msub> <mi>x</mi> <mi>i</mi> </msub> <mo>(</mo> <msub> <mi>&amp;omega;</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>&amp;psi;</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>&amp;gamma;</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>X</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>Y</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>Z</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <mi>f</mi> <mo>,</mo> <mi>x</mi> <msub> <mi>p</mi> <mi>L</mi> </msub> <mo>,</mo> <mi>y</mi> <msub> <mi>p</mi> <mi>L</mi> </msub> <mo>,</mo> <msub> <mi>K</mi> <mrow> <mn>1</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>K</mi> <mrow> <mn>2</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>K</mi> <mrow> <mn>3</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>P</mi> <mrow> <mn>1</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>P</mi> <mrow> <mn>2</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>b</mi> <mrow> <mn>1</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>b</mi> <mrow> <mn>2</mn> <mi>L</mi> </mrow> </msub> <mo>)</mo> </mtd> </mtr> <mtr> <mtd> <mi>F</mi> <msub> <mi>y</mi> <mi>i</mi> </msub> <mo>(</mo> <msub> <mi>&amp;omega;</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>&amp;psi;</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>&amp;gamma;</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>X</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>Y</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>Z</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>,</mo> <mi>f</mi> <mo>,</mo> <mi>x</mi> <msub> <mi>p</mi> <mi>L</mi> </msub> <mo>,</mo> <mi>y</mi> <msub> <mi>p</mi> <mi>L</mi> </msub> <mo>,</mo> <msub> <mi>K</mi> <mrow> <mn>1</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>K</mi> <mrow> <mn>2</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>K</mi> <mrow> <mn>3</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>P</mi> <mrow> <mn>1</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>P</mi> <mrow> <mn>2</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>b</mi> <mrow> <mn>1</mn> <mi>L</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>b</mi> <mrow> <mn>2</mn> <mi>L</mi> </mrow> </msub> <mo>)</mo> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>18</mn> <mo>)</mo> </mrow> </mrow>
构造迭代式采用高斯-牛顿法求解:
<mrow> <msup> <mi>P</mi> <mrow> <mi>k</mi> <mo>+</mo> <mn>1</mn> </mrow> </msup> <mo>=</mo> <msup> <mi>P</mi> <mi>k</mi> </msup> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msubsup> <mi>J</mi> <mi>k</mi> <mi>T</mi> </msubsup> <msub> <mi>J</mi> <mi>k</mi> </msub> <mo>)</mo> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <msubsup> <mi>J</mi> <mi>k</mi> <mi>T</mi> </msubsup> <msub> <mi>F</mi> <mi>k</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>19</mn> <mo>)</mo> </mrow> </mrow>
据此求得双目左目相机的标定参数ωLmLmLm,XLm,YLm,ZLm,fL,xpL,ypL,K1L,K2L,K3L,P1L,P2L,b1L,b2L
同理,将右目相机对星上靶标反射目标的成像位置坐标(xiRm,yiRm)与底板基准镜坐标系下的坐标(XJi,YJi,ZJi)一一对应,列2*m*N个方程,求解右目相机参数,包括:
fR表示右目相机焦距;
xpR表示右目相机图像中心在xR方向的偏移量;
ypR表示右目相机图像中心在yR方向的偏移量;
K1R表示右目相机一阶径向畸变修正系数;
K2R表示右目相机二阶径向畸变修正系数;
K3R表示右目相机三阶径向畸变修正系数;
P1R表示右目相机偏心畸变修正系数1;
P2R表示右目相机偏心畸变修正系数2;
b1R表示右目相机像平面畸变修正系数1;
b2R表示右目相机像平面畸变修正系数2;
定义双目右目相机本体坐标系OBRXBRYBRZBR,右目相机本体坐标系OBRXBRYBRZBR是一个坐标系原点和坐标系指向待确定的空间坐标系,双目右目相机本体坐标系OBRXBRYBRZBR的原点OBR位于相机光学***光心位置,列增大方向为XBR方向,行减小方向为YBR方向,ZBR方向按照右手法则定义;RwRmRmRmRm)表示第m张图像拍摄时,双目右目相机本体坐标系OBRXBRYBRZBR至基准镜坐标系OJXJYJZJ的旋转矩阵,ωRmRmRm分别为与旋转阵对应的旋转角度。
10.根据权利要求1所述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:所述步骤(九)中,双目左、右目相机之间的位置和姿态关系按照下式计算:
<mrow> <msub> <mi>R</mi> <mi>m</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;omega;</mi> <mi>m</mi> </msub> <mo>,</mo> <msub> <mi>&amp;psi;</mi> <mi>m</mi> </msub> <mo>,</mo> <msub> <mi>&amp;gamma;</mi> <mi>m</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msubsup> <mi>Rw</mi> <mrow> <mi>R</mi> <mi>m</mi> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mo>&amp;CenterDot;</mo> <msub> <mi>Rw</mi> <mrow> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>20</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>T</mi> <mi>m</mi> </msub> <mo>=</mo> <mo>-</mo> <msubsup> <mi>Rw</mi> <mrow> <mi>R</mi> <mi>L</mi> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mo>&amp;CenterDot;</mo> <msub> <mi>Rw</mi> <mrow> <mi>L</mi> <mi>R</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>T</mi> <mi>R</mi> </msub> <mo>+</mo> <msub> <mi>T</mi> <mi>L</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>21</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>T</mi> <mo>=</mo> <mfrac> <mn>1</mn> <mi>m</mi> </mfrac> <mrow> <mo>(</mo> <msub> <mi>T</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>T</mi> <mn>2</mn> </msub> <mo>+</mo> <mn>...</mn> <msub> <mi>T</mi> <mi>m</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>22</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>&amp;omega;</mi> <mo>=</mo> <mfrac> <mn>1</mn> <mi>m</mi> </mfrac> <mrow> <mo>(</mo> <msub> <mi>&amp;omega;</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>&amp;omega;</mi> <mn>2</mn> </msub> <mo>+</mo> <mn>...</mn> <mo>+</mo> <msub> <mi>&amp;omega;</mi> <mi>m</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>23</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>&amp;psi;</mi> <mo>=</mo> <mfrac> <mn>1</mn> <mi>m</mi> </mfrac> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>&amp;psi;</mi> <mn>2</mn> </msub> <mo>+</mo> <mn>...</mn> <mo>+</mo> <msub> <mi>&amp;psi;</mi> <mi>m</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>24</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>&amp;gamma;</mi> <mo>=</mo> <mfrac> <mn>1</mn> <mi>m</mi> </mfrac> <mrow> <mo>(</mo> <msub> <mi>&amp;gamma;</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>&amp;gamma;</mi> <mn>2</mn> </msub> <mo>+</mo> <mn>...</mn> <mo>+</mo> <msub> <mi>&amp;gamma;</mi> <mi>m</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>25</mn> <mo>)</mo> </mrow> </mrow>
式中,TL=(XLm,YLm,ZLm)T,TR=(XRm,YRm,ZRm)T
Rmmmm)表示第m张图像拍摄时,左目相机本体系到右目相机本体系的旋转阵,ωmmm分别为与旋转阵对应的旋转角度;
Tm表示第m张图像拍摄时,右目相机本体系原点在左目相机本体系下坐标;
T表示右目相机本体系原点在左目相机本体系下坐标;ω表示左目相机本体系相对于右目相机本体系的俯仰角;
ψ表示左目相机本体系相对于右目相机本体系的偏航角;
γ表示左目相机本体系相对于右目相机本体系的滚转角。
11.根据权利要求1所述的大视场宽工作距双目相机的在轨几何校正及精度验证方法,其特征在于:所述步骤(十)中,按照下式计算双目相机在轨标定后的精度:
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;x</mi> <mrow> <mi>r</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>K</mi> <mrow> <mn>1</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mn>2</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>4</mn> </msubsup> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mn>3</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>6</mn> </msubsup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;y</mi> <mrow> <mi>r</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>K</mi> <mrow> <mn>1</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mn>2</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>4</mn> </msubsup> <mo>+</mo> <msub> <mi>K</mi> <mrow> <mn>3</mn> <mi>L</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>6</mn> </msubsup> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>26</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;x</mi> <mi>d</mi> </msub> <mo>=</mo> <msub> <mi>P</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>+</mo> <mn>2</mn> <msubsup> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> <mo>+</mo> <mn>2</mn> <msub> <mi>P</mi> <mn>2</mn> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;y</mi> <mi>d</mi> </msub> <mo>=</mo> <msub> <mi>P</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>+</mo> <mn>2</mn> <msubsup> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> <mo>+</mo> <mn>2</mn> <msub> <mi>P</mi> <mn>1</mn> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>27</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;x</mi> <mi>m</mi> </msub> <mo>=</mo> <msub> <mi>b</mi> <mn>1</mn> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>b</mi> <mn>2</mn> </msub> <mo>&amp;CenterDot;</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;y</mi> <mi>m</mi> </msub> <mo>=</mo> <mn>0</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>28</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msubsup> <mi>r</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mn>2</mn> </msubsup> <mo>=</mo> <msup> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mn>2</mn> </msup> <mo>+</mo> <msup> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mn>2</mn> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>29</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msubsup> <mi>&amp;Delta;x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <msub> <mi>&amp;Delta;x</mi> <mrow> <mi>r</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>&amp;Delta;x</mi> <mrow> <mi>d</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>&amp;Delta;x</mi> <mrow> <mi>m</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>xp</mi> <mi>L</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>&amp;Delta;y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <msub> <mi>&amp;Delta;y</mi> <mrow> <mi>r</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>&amp;Delta;y</mi> <mrow> <mi>d</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>&amp;Delta;y</mi> <mrow> <mi>m</mi> <mo>-</mo> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>yp</mi> <mi>L</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>30</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msubsup> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msubsup> <mi>&amp;Delta;x</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> <mo>=</mo> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> </msub> <mo>+</mo> <msubsup> <mi>&amp;Delta;y</mi> <mrow> <mi>i</mi> <mi>L</mi> <mi>m</mi> </mrow> <mo>&amp;prime;</mo> </msubsup> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>31</mn> <mo>)</mo> </mrow> </mrow>
式中,x′iLm和y′iLm分别表示左目相机图像上第i个目标校正后xL方向、yL方向的坐标分量;
同理,计算右目相机图像上第i个目标经过畸变校正后的坐标(x′iRm,y′iRm);x′iRm和y′iRm分别表示右目相机图像上第i个目标校正后xR方向、yR方向的坐标分量;
表示左目相机光心到右目相机光心的单位矢量;
rzDL=[0 0 1],表示左目相机光轴方向矢量;
表示由rzDL方向和ryLv方向叉乘得到的单位矢量方向;
rzLv=rxLv×ryLv,表示由rxLv方向和ryLv方向叉乘得到矢量方向;
定义左目相机虚拟坐标系,坐标系原点位于左目相机光心位置,rxLv为正XVL方向,ryLv为正YVL方向,rzLv为正ZVL方向;
定义右目相机虚拟坐标系,坐标系原点位于右目相机光心位置,三轴方向与左目相机虚拟坐标系指向一致,三轴方向分别为XVR,YVR和ZVR
RVL2DL=[rxLvT ryLvT rzLvT],表示左目相机虚拟坐标系至左目相机本体系的旋转阵;
表示右目相机本体系至右目相机虚拟坐标系的旋转阵;
表示左目相机第m张图像上第i个标志成像位置修正后在左目相机虚拟坐标下的坐标,XimVL,YimVL,ZimVL分别为坐标在左目相机虚拟坐标XVL方向、YVL方向和ZVL方向的分量;
[XimVR YimVR ZimVR]T=RDR2VR·[x′ipRm y′ipRm -fR]T,表示右目相机第m张图像上第i个标志成像位置修正后在右目相机虚拟坐标下的坐标,XimVR,YimVR,ZimVR分别为坐标在右目相机虚拟坐标XVR方向、YVR方向和ZVR方向的分量;
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>m</mi> <mi>v</mi> <mi>l</mi> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <msub> <mi>f</mi> <mi>L</mi> </msub> <msub> <mi>Z</mi> <mrow> <mi>i</mi> <mi>m</mi> <mi>V</mi> <mi>L</mi> </mrow> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>X</mi> <mrow> <mi>i</mi> <mi>m</mi> <mi>V</mi> <mi>L</mi> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>m</mi> <mi>v</mi> <mi>l</mi> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <msub> <mi>f</mi> <mi>L</mi> </msub> <msub> <mi>Z</mi> <mrow> <mi>i</mi> <mi>m</mi> <mi>V</mi> <mi>L</mi> </mrow> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>Y</mi> <mrow> <mi>m</mi> <mi>V</mi> <mi>L</mi> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>32</mn> <mo>)</mo> </mrow> </mrow>
(ximvl,yimvl)表示左目相机第m张图像上第i个标志成像位置修正后重投影得到像点坐标,ximvl,yimvl分别为XVL方向和YVL方向的分量;
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mi>m</mi> <mi>v</mi> <mi>r</mi> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <msub> <mi>f</mi> <mi>L</mi> </msub> <msub> <mi>Z</mi> <mrow> <mi>i</mi> <mi>m</mi> <mi>V</mi> <mi>R</mi> </mrow> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>X</mi> <mrow> <mi>i</mi> <mi>m</mi> <mi>V</mi> <mi>R</mi> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>y</mi> <mrow> <mi>i</mi> <mi>m</mi> <mi>v</mi> <mi>r</mi> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <msub> <mi>f</mi> <mi>L</mi> </msub> <msub> <mi>Z</mi> <mrow> <mi>i</mi> <mi>m</mi> <mi>V</mi> <mi>R</mi> </mrow> </msub> </mfrac> <mo>&amp;CenterDot;</mo> <msub> <mi>Y</mi> <mrow> <mi>m</mi> <mi>V</mi> <mi>R</mi> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>33</mn> <mo>)</mo> </mrow> </mrow>
(ximvr,yimvr)表示右目相机第m张图像上第i个标志成像位置修正后重新投影得到像点坐标,ximvr,yimvr分别为XVR方向和YVR方向的分量;
erri=yimvr-yimvl表示左目相机、右目相机第m张图像上第i个标志成像位置修正并重新投影后像点在YVL方向的偏差量。
CN201711250032.7A 2017-12-01 2017-12-01 大视场宽工作距双目相机的在轨几何校正及精度验证方法 Active CN107967700B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711250032.7A CN107967700B (zh) 2017-12-01 2017-12-01 大视场宽工作距双目相机的在轨几何校正及精度验证方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711250032.7A CN107967700B (zh) 2017-12-01 2017-12-01 大视场宽工作距双目相机的在轨几何校正及精度验证方法

Publications (2)

Publication Number Publication Date
CN107967700A true CN107967700A (zh) 2018-04-27
CN107967700B CN107967700B (zh) 2020-02-14

Family

ID=61997830

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711250032.7A Active CN107967700B (zh) 2017-12-01 2017-12-01 大视场宽工作距双目相机的在轨几何校正及精度验证方法

Country Status (1)

Country Link
CN (1) CN107967700B (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109084963A (zh) * 2018-08-02 2018-12-25 北京空间机电研究所 一种遥感器在轨标定光源发射***
CN109186639A (zh) * 2018-10-29 2019-01-11 中国船舶重工集团公司第七0七研究所 一种高精度姿态变化量测量方法
CN112070843A (zh) * 2020-08-04 2020-12-11 北京空间机电研究所 一种空间相机几何参数在轨标定方法
CN112070845A (zh) * 2020-08-31 2020-12-11 上海爱观视觉科技有限公司 双目相机的标定方法、装置及终端设备
CN113034610A (zh) * 2021-03-17 2021-06-25 北京控制工程研究所 一种基于天文技术的空间指向测量仪器标定方法
CN114004947A (zh) * 2021-11-09 2022-02-01 北京环境特性研究所 一种空间目标几何模型的修正方法和装置

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2256576A1 (en) * 2009-05-29 2010-12-01 Datacard Corporation System for the calibration of operating parameters of a laser engraver
WO2010136600A1 (en) * 2009-05-29 2010-12-02 Datacard Corporation System for the calibration of operating parameters of a laser engraver
CN102032878A (zh) * 2009-09-24 2011-04-27 甄海涛 基于双目立体视觉测量***的精确在线测量方法
CN107167790B (zh) * 2017-05-24 2019-08-09 北京控制工程研究所 一种基于标定场的激光雷达两步标定方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2256576A1 (en) * 2009-05-29 2010-12-01 Datacard Corporation System for the calibration of operating parameters of a laser engraver
WO2010136600A1 (en) * 2009-05-29 2010-12-02 Datacard Corporation System for the calibration of operating parameters of a laser engraver
CN102032878A (zh) * 2009-09-24 2011-04-27 甄海涛 基于双目立体视觉测量***的精确在线测量方法
CN107167790B (zh) * 2017-05-24 2019-08-09 北京控制工程研究所 一种基于标定场的激光雷达两步标定方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
JINGHAO YANG ET AL.: "Improved calibration method of binocular vision measurement system for large hot forging", 《2016 IEEE 25TH INTERNATIONAL SYMPOSIUM ON INDUSTRIAL ELECTRONICS (ISIE)》 *
XUEDONG LI ET AL.: "Noise analysis and external parameters calibration for binocular fisheye cameras", 《PROCEEDINGS OF THE 30TH CHINESE CONTROL CONFERENCE》 *

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109084963A (zh) * 2018-08-02 2018-12-25 北京空间机电研究所 一种遥感器在轨标定光源发射***
CN109186639A (zh) * 2018-10-29 2019-01-11 中国船舶重工集团公司第七0七研究所 一种高精度姿态变化量测量方法
CN109186639B (zh) * 2018-10-29 2022-04-12 中国船舶重工集团公司第七0七研究所 一种高精度姿态变化量测量方法
CN112070843A (zh) * 2020-08-04 2020-12-11 北京空间机电研究所 一种空间相机几何参数在轨标定方法
CN112070843B (zh) * 2020-08-04 2024-03-15 北京空间机电研究所 一种空间相机几何参数在轨标定方法
CN112070845A (zh) * 2020-08-31 2020-12-11 上海爱观视觉科技有限公司 双目相机的标定方法、装置及终端设备
CN112070845B (zh) * 2020-08-31 2024-02-02 安徽爱观视觉科技有限公司 双目相机的标定方法、装置及终端设备
CN113034610A (zh) * 2021-03-17 2021-06-25 北京控制工程研究所 一种基于天文技术的空间指向测量仪器标定方法
CN113034610B (zh) * 2021-03-17 2022-06-03 北京控制工程研究所 一种基于天文技术的空间指向测量仪器标定方法
CN114004947A (zh) * 2021-11-09 2022-02-01 北京环境特性研究所 一种空间目标几何模型的修正方法和装置
CN114004947B (zh) * 2021-11-09 2024-06-21 北京环境特性研究所 一种空间目标几何模型的修正方法和装置

Also Published As

Publication number Publication date
CN107967700B (zh) 2020-02-14

Similar Documents

Publication Publication Date Title
CN107967700A (zh) 大视场宽工作距双目相机的在轨几何校正及精度验证方法
CN110057295B (zh) 一种免像控的单目视觉平面距离测量方法
CN110310248B (zh) 一种无人机遥感影像实时拼接方法及***
JP7037302B2 (ja) 測量データ処理装置、測量データ処理方法および測量データ処理用プログラム
CN103674063B (zh) 一种光学遥感相机在轨几何定标方法
CN104897175B (zh) 多相机光学推扫卫星在轨几何定标方法及***
JP4448187B2 (ja) 映像の幾何補正方法およびその装置
CN104764443B (zh) 一种光学遥感卫星严密成像几何模型构建方法
CN107014399B (zh) 一种星载光学相机-激光测距仪组合***联合检校方法
CN105424058B (zh) 基于摄影测量技术的数码相机投影中心位置精确标定方法
CN106885585B (zh) 一种基于光束法平差的星载摄影测量***一体化检校方法
CN104363438B (zh) 全景立体影像制作方法
CN113551665B (zh) 一种用于运动载体的高动态运动状态感知***及感知方法
CN109631876B (zh) 一种基于单相机导航影像的巡视探测器定位方法
CN110211054A (zh) 一种星载推扫式光学传感器无畸变影像制作方法
CN103364012A (zh) 一种带约束条件的多面阵航摄仪平台检校方法
CN108375383A (zh) 多相机辅助的机载分布式pos柔性基线测量方法和装置
CN110986888A (zh) 一种航空摄影一体化方法
CN109724625B (zh) 一种光学复合大面阵测绘相机的像差改正方法
KR20130121290A (ko) 회전식 라인 카메라로 획득한 실내 전방위 영상의 지오레퍼런싱 방법
CN108594255B (zh) 一种激光测距辅助光学影像联合平差方法及***
Yuan A novel method of systematic error compensation for a position and orientation system
Zhao et al. Direct georeferencing of oblique and vertical imagery in different coordinate systems
CN113947638A (zh) 鱼眼相机影像正射纠正方法
Han et al. A direct determination of the orientation parameters in the collinearity equations

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant