一种光学单站姿态处理二义性正确解确定方法_胡小丽.pdf

文章编号：1002-2082(2023)01-0055-06一种光学单站姿态处理二义性正确解确定方法胡小丽1，唐明刚1，蔡文泽2，吴海英1，张思琪2，张三喜1（1.华阴兵器试验中心，陕西华阴714200；2.西安现代控制技术研究所，陕西西安710065）摘摘 要：要：因单站成像的信息欠缺以及成像的对称性，光学单站姿态处理的二义性是普遍性难点问题，针对光学单站姿态处理二义性解问题，以目标主体直线矢量与姿态角对应关系为突破点，以主体直线矢量的物像映射关系为单站姿态处理基础，从处理结果界定局部二义性错误解，然后根据单站姿态求解关键步骤修正二义性解，修正前后处理结果与常规交会处理结果比较效果显著，在文中所述场景下，误差量级至少缩小 20%，该方法为光学单站姿态处理获取正确解提供了可靠理论支持。关键词：关键词：光学测量；姿态处理；二义性解；对称性中图分类号：TN29；TP394.1文献标志码：ADOI：10.5768/JAO202344.0101008Determination method for ambiguous correct solution of opticalsingle-station pose processingHUXiaoli1，TANGMinggang1，CAIWenze2，WUHaiying1，ZHANGSiqi2，ZHANGSanxi1（1.HuayinOrdnanceTestCenter,Huayin714200,China；2.XianModernControlTechnologyResearchInstitute,Xian710065,China）Abstract：Duetothelackofinformationandthesymmetricalimagingofsingle-stationimaging,theambiguityoftheopticalsingle-stationposeprocessingisacommonanddifficultproblem.Aimingattheambiguoussolutionofopticalsingle-stationposeprocessing,thecorrespondingrelationshipbetweenthetargetsubjectstraight-linevectorandtheposeanglewastakenasthebreakthroughpoint,andtheobject-imagemappingrelationshipofthetargetsubjectstraight-linevectorwastakenasthebasisofsingle-stationposeprocessing.Definedthepartialambiguouserrorsolutionfromthesingle-stationposeprocessingresults,andthentheambiguoussolutionwasmodifiedaccordingtothekeystepsofsingle-stationposesolution.Theeffectsofprocessing results before and after ambiguous correction were significant compared with that of theconventionalintersectionprocessingresults.Inthedescribedscenario,theerrormagnitudeisreducedbyatleast20%.Thismethodprovidesareliabletheoreticalsupportforobtainingthecorrectsolutionofopticalsingle-stationposeprocessing.Key words：opticalmeasurement；poseprocessing；ambiguoussolution；symmetry引言按照物像成像方式的对称性，光学单站姿态处理难以避免处理结果的二义性，因判读误差、其它输入参数测量误差耦合原因，处理结果并不会出现多解现象，优化处理结果通常处理为单解形式，除粗大误差外，数据趋势结果多表现为分段显著的 2 种变化趋势，如何通过单站序列图像姿态处理结果，将正确二义解解算出来，一直是单站姿态处理的固有难题。查阅大量单站姿态处理及姿态处理文献1-15，尚未见二义性修正相关报道。本文以基于直线矢量的物像映射关系为基础，从单站姿态处理结果着手分析数据结果曲线规收稿日期：2022-03-04；修回日期：2022-04-28基金项目：一般科研项目（012016018200A22304）作者简介：胡小丽（1979），女，工程师，主要从事光学姿态测量及数据处理技术研究。E-mail：第44卷第1期应用光学Vol.44No.12023年1月JournalofAppliedOpticsJan.2023律，根据曲线变化趋势确定整体正确解，之后对局部错误二义性解进行修正，后反向变换至基准坐标系中获取求解时刻特征矢量空间矢量，对矢量进行解析获取正确姿态解。1 算法分析1.1 目标主体直线矢量选取依据目标坐标系主体架构，分别是目标中轴、目标尾翼以及与前两者垂直的目标特征，这 3 者可作为直线矢量选取的 3 个矢量基，分别是 e1(100)T、e2(010)T、e3(001)T，其他目标直线矢量均可由这3 者组合而成。按照姿态处理通常坐标系定义，3 个矢量基由初始零姿态向求解时刻姿态旋转为（e1e2e3)，有：(e1e2e3)=R(YT,)R(ZT,)R(XT,)(e1e2e3)（1）式中：R 为姿态旋转过程中涉及的矩阵。由（e1e2e3)中涉及的姿态角可获得各类直线矢量涉及的姿态角信息，为后续特征直线矢量选取提供依据。1.2 单站姿态处理算法关键步骤分析1）能表征需求姿态角的关键直线矢量选择，如中轴、尾翼等直线矢量；L1 L22）上述关键矢量由初始零姿态经 3 姿态角（偏航、俯仰、滚转）旋转至求解时刻矢量状态，如图 1 所示、；YO目标坐标系XOCminf(x)=(klRklS)2XCL2l1Rl1Sl2Sl2SL1YCZCZ摄像机坐标系测量基准系图 1 单站直线矢量姿态映射图示Fig.1 Diagram of pose mapping for single-station straightline vector l1S l2S3）将上一步矢量模拟投影映射至摄像机坐标系，进一步转换为像面坐标系模拟矢量状态、；l1R l2R4）在实际图像中提取中轴矢量、尾翼矢量实际成像矢量、；5）模拟矢量与实际矢量匹配，由于姿态实质minf(x)=(kliRkliS)2基于方向相对关系，故可仅匹配对应矢量之间的方向表征即可，即匹配成像斜率即可，求解即可获取所需的姿态角信息。坐标系说明：所有涉及坐标系以常规姿态处理算法中涉及的坐标系为基准。其中目标坐标系以目标中轴为 XT轴，头部为正；基准坐标系以北向为 X 轴；摄像机坐标系以光轴指向为 XC轴，平行于像面向上为 YC轴；像面坐标系 y、z 轴分别平行于像机坐标系 YC轴、ZC轴。1.3 单站姿态处理二义性正确解获取取典型目标关键直线矢量向像面映射的俯视图进行二义性说明，2 类目标共处于摄像机坐标系下进行投影变换，左侧为弹类目标，以中轴作为其关键矢量；右侧为飞机类目标，以中轴矢量和尾翼矢量作为其关键矢量；2 种目标相对 ZC轴呈完全对称模式，故相对像面成像状态完全等效，若出现解的二义性，必为此环节所致。弹类、飞机类目标相对像面投影二义性说明，如图 2 所示。可能解 1XC可能解 2可能解 2ZC弹类目标模拟飞机类目标模拟可能解 1图 2 弹类、飞机类目标相对像面投影二义性说明Fig.2 Ambiguous description of projection to image planeof missile and aircraft targets根据 1.2 单站姿态处理算法关键步骤分析，可知光学单站姿态测量二义性，实质是目标关键矢量相对于摄像机像面投影的对称性，按照常规姿态测量坐标系定义，则实质是目标关键矢量在X 方向的分量相对于摄像机像面投影的对称二义性。基于姿态测量关键矢量物像映射及空间重构过程，本文提出了二义性正确解获取流程。单站姿态处理二义性正确解修正步骤，如图 3 所示。以弹类轴对称回转体目标为例，具体分析过程如下：1）对单站序列图像姿态处理结果（偏航角、俯仰角）进行分析，数据变换趋势总体趋势为正确解趋势，其中局部集合存在单站姿态处理的二义性解；56应用光学第44卷第1期2）主流变化趋势保留，根据二义性错误解反向推断正确解，按照 1.3 节所述，必须将此二义解由基准坐标系变换至摄像机坐标系下反向推算正确映射结果，代入单站姿态处理二义性错误解（偏航角、俯仰角）和光轴指向（AE），将中轴矢量（100）T由求解时刻状态 L(coscossinsincos)T向摄像机坐标系变换映射得到 Lc（lCmCnC）T；LC=R(E)R(A)L（2）3）将 Lc（lCmC nC）T修正为 Lc（lCmC nC）T；4）将 Lc（lCmC nC）T反向变换至基准坐标系，得中轴矢量求解时刻正确解 L(l m n)T；L=R(A)R(E)LC（3）5）解析 L(lm n)T，获取正确解、。=tan1(nl)=tan1(ml2+n2)（4）飞机类则按照中轴矢量流程增加尾翼矢量，解析 3 个姿态角。2 算法验证2.1 平飞段二义性修正实验航线姿态设置及布站：某飞机沿主靶道近似平飞；机上有遥测位置姿态数据；分站 1#布设于飞机弹道侧方，其中 X，Z 分别为：（3500m，1500m）；飞机飞行航迹与飞行姿态参数：X（4400m6600m），Z（295m37m），Y（1182m1184m），（7.32.3），（0.62），（3.58.6）其中，Y、均为量值变化范围，变化过程随飞机飞行过程呈现非均匀起伏状态。处理条件：分别提取飞机中轴和尾翼直线特征，各边成像以通常定义的目标体坐标系为依据，分别为中轴（178pixs48pixs）、尾翼（451pixs338pixs），其中中轴线性特征良好，尾翼线性特征一般。如图 4 所示，单站姿态测量数据总体与遥测数据吻合良好，由于判读误差的随机性，存在一定的随机误差。需要注意的是，3 个姿态角的起始段落，同步相对遥测数据有明显偏差，考虑处理算法的影响因素，定位为二义性错误解。1001020304060507080123456789101112131415161718192021222324251234567891011121314151617181920212223242512345678910111213141516171819202122232425偏航角/()相对时间/s(a)偏航角处理结果偏航角-遥测偏航角1#50510152025俯仰角/()相对时间/s(b)俯仰角处理结果俯仰角-遥测俯仰角1#121068420246滚转角/()相对时间/s(c)滚转角处理结果滚转角-遥测滚转角1#图 4 飞机姿态数据处理-平飞Fig.4 Data processing of aircraft in level flight attitude按照 1.3 节对上述数据进行二义性修正。从图 5 可知，相比于图 4，与遥测数据对比差异明显减少，整体更多体现的是判读误差的随机性。相对误差均方根指标二义性修正前后如表 1所示。表 1 进一步说明，二义性修正前后相对遥测结果差异明显，精度量级得到了显著提高。正确解二义部分开始姿态处理后二义性区域识别参与计算的直线矢量以二义错误解旋转变换至摄像机坐标系获取摄像机坐标系下的对称解将对称解旋转变换至基准坐标系获取关键直线矢量空间直线矢量解析空间直线矢