CN114877871B - 未标定视频卫星进行深空目标观测的姿态凝视控制方法 - Google Patents
未标定视频卫星进行深空目标观测的姿态凝视控制方法 Download PDFInfo
- Publication number
- CN114877871B CN114877871B CN202210487940.2A CN202210487940A CN114877871B CN 114877871 B CN114877871 B CN 114877871B CN 202210487940 A CN202210487940 A CN 202210487940A CN 114877871 B CN114877871 B CN 114877871B
- Authority
- CN
- China
- Prior art keywords
- camera
- matrix
- estimated value
- deep space
- vector
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 79
- 238000003384 imaging method Methods 0.000 claims abstract description 31
- 238000009434 installation Methods 0.000 claims abstract description 8
- 239000013598 vector Substances 0.000 claims description 115
- 239000011159 matrix material Substances 0.000 claims description 98
- 230000009466 transformation Effects 0.000 claims description 33
- 238000006243 chemical reaction Methods 0.000 claims description 26
- 230000008569 process Effects 0.000 claims description 18
- 238000004364 calculation method Methods 0.000 claims description 7
- 230000003287 optical effect Effects 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 3
- 230000004927 fusion Effects 0.000 claims description 2
- 230000015572 biosynthetic process Effects 0.000 claims 1
- 238000004088 simulation Methods 0.000 description 8
- 230000008859 change Effects 0.000 description 3
- 230000003044 adaptive effect Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 125000004122 cyclic group Chemical group 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000036544 posture Effects 0.000 description 1
- 239000000243 solution Substances 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
- G01C11/36—Videogrammetry, i.e. electronic processing of video signals from a single source or from different sources to give parallax or range information
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Multimedia (AREA)
- Signal Processing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开一种未标定视频卫星进行深空目标观测的姿态凝视控制方法,涉及航天器姿态控制技术领域。所述方法的步骤包括:首先根据相机内部的成像模型以及相机在视频卫星上的安装位置,确定需要进行估计的参数初始估计值;然后,然后根据图像中识别到的目标的像素坐标信息以及所述参数初始估计值,利用给出的参数更新律求出当前时刻的参数估计值;最后,根据当前时刻的参数估计值计算当前时刻的姿态控制力矩。根据本发明提出的姿态凝视控制方法可以设计视频卫星对深空目标进行凝视观测时的姿态控制器,使得即使视频卫星搭载的相机参数在未标定的情况下仍能实现对深空目标的高精度凝视观测。
Description
技术领域
本发明涉及航天器姿态控制技术领域,尤其涉及一种未标定视频卫星进行深空目标观测的姿态凝视控制方法。
背景技术
在天文观测等场景中对深空目标观测时需要对目标进行稳定持续的高精度凝视。视频卫星因其能够对观测目标实现连续的跟踪并且获取视频信息,使得它在持续目标跟踪场合有着得天独厚的优势,因而具有广阔的应用前景。目前发展的在轨视频卫星有诸如国内的吉林1号、天拓2号以及国外的LAPAN-tubsat等。利用视频卫星实现深空目标凝视跟踪通常可分为基于位置信息和图像信息的跟踪控制两种方法。
传统的基于目标位置信息的凝视控制,首先根据目标先验位置信息设计出稳定凝视时卫星的期望姿态,然后通过PD控制等方式实现姿态的机动和跟踪。然而,当目标位置信息未知情况下,基于给定目标位置的传统凝视控制方法并不适用。
基于相机图像的凝视控制方法不需要目标的位置信息,利用现代图像识别技术提取出观测目标在像平面中像素坐标,然后利用该像素坐标与期望坐标之间的误差进行反馈控制卫星。由于目标在惯性空间中的位置速度并不可知,控制器若要根据目标成像的像素坐标将其控制到期望的图像中的位置,一般需要根据相机的内外参数,将像素偏差转换为当前姿态与期望姿态之差,然后设计合适的控制律使得姿态误差收敛,最后间接实现将目标成像移动到像平面中期望的位置。但是该方法需要依赖准确的相机参数才能实现有效跟踪控制。然而,卫星相机参数在长期的在轨运行过程中不可避免会发生变化,在轨标定相机内外参数十分困难。
基于未标定相机进行视觉伺服控制在机器人、无人机等领域有许多的研究工作,但目前尚未有针对未标定的视频卫星跟踪控制的相关研究报道。因此,相机参数未标定的视频卫星在深空目标位置信息未知条件下执行观测任务时的高精度姿态凝视控制仍然是面临的一个棘手的技术问题。
发明内容
本发明要解决的技术问题就在于:针对现有技术存在的技术问题,本发明提供一种未标定视频卫星进行深空目标观测的姿态凝视控制方法。
为解决上述技术问题,本发明提出的技术方案为:
步骤1,根据相机内部的成像模型以及相机在视频卫星上的安装位置,确定需要进行估计的相机参数向量初始估计值;
步骤2,根据图像中识别到的目标的像素坐标信息以及所述相机参数向量初始估计值,利用预设的参数更新律求出当前时刻相机参数的估计值;
步骤3,根据所述相机参数向量初始估计值,计算当前时刻需要输出给视频卫星的姿态控制力矩以对视频卫星的姿态进行控制;
步骤4,将步骤2获得的当前时刻所述相机参数的估计值作为新的相机参数向量初始估计值,不断地重复步骤2和步骤3,以不断计算下一时刻所述相机参数的估计值以及下一时刻需要输出给视频卫星的姿态控制力矩,实现对视频卫星的姿态的控制,直至视频卫星的深空目标观测任务结束。
进一步的,所述步骤1包括步骤11~14:
步骤11,根据相机内部的成像模型和相机在视频卫星上的安装位置,给出相机投影转换矩阵的初始估计值;
所述相机投影转换矩阵为一个维的矩阵,表达式为:
,
式中,为所述相机投影转换矩阵,为相机焦距,和分别为镜头中心光轴与像平面相交形成的像平面中心的横坐标和纵坐标,和分别为单个像素的物理长度和物理宽度;表示由卫星本体坐标系到相机坐标系的转换矩阵;表示相机在卫星本体坐标系中的安装位置矢量在相机坐标系中的分量;表示1行3列的全零行向量;
所述相机投影转换矩阵的初始估计值通过将理想状况下的物理参数、、、、、和的值代入到所述相机投影转换矩阵的表达式中得到;
步骤12,获取待观测的深空目标在地心惯性坐标系中的位置矢量的初始估计值;
所述深空目标在地心惯性坐标系中的位置矢量记为;所述深空目标在地心惯性坐标系中的位置矢量的初始估计值记为;
步骤13,根据所述相机投影转换矩阵的初始估计值和所述深空目标在地心惯性坐标系中的位置矢量的初始估计值,获取得到相机参数向量;
所述相机参数向量定义为:
式中,表示相机投影转换矩阵的第i行、第j列元素,其中,i= 1、2、3,j= 1、2、3,例如,为相机投影转换矩阵的第1行、第1列元素,为相机投影转换矩阵的第3行、第1列元素,为相机投影转换矩阵的第3行、第3列元素;表示深空目标在地心惯性坐标系中的位置矢量的第k个分量,其中,,例如,表示的第1个分量,表示的第2个分量,表示的第3个分量;为相机投影转换矩阵的第1行、第4列元素,为相机投影转换矩阵的第2行、第4列元素,为相机投影转换矩阵的第3行、第4列元素;上标T表示向量的转置;
步骤14,对所述相机参数向量进行简化,得到t时刻简化后的相机参数向量的初始估计值;
所述对所述相机参数向量进行简化包括:将所述相机参数向量中的元素固定设置为1,得到简化后的相机参数向量为:
式中,表示简化后的相机参数向量,表示相机投影转换矩阵的第i行、第j列元素;表示深空目标在地心惯性坐标系中的位置矢量的第k个分量;
所述t时刻简化后的相机参数向量的初始估计值为需要进行估计的相机参数向量初始估计值,通过将相机投影转换矩阵的初始估计值和深空目标在地心惯性坐标系中的位置矢量的初始估计值代入到的表达式得到。
可选的,所述步骤12中,相机内部的成像模型采用针孔成像模型。
可选的,所述步骤12中,深空目标在地心惯性坐标系中的位置矢量的初始估计值通过先验知识信息或融合已知信息估算得到。
进一步的,所述步骤2包括步骤21~23:
步骤21:利用t时刻简化后的相机参数向量的初始估计值,计算t时刻的估计投影误差和t时刻与相机参数向量无关的矩阵;
所述t时刻的估计投影误差的表达式为:
式中,为t时刻目标在相机坐标系z轴上的分量的初始估计值;为深空目标在像平面的实际成像坐标,其中、分别为在像平面横、纵两轴上的坐标分量,由实际图像提取得到像平面上的目标成像坐标;为投影转换矩阵初始估计值的前两行元素组成的矩阵;为自定义矩阵,,其中,为地心惯性坐标系到卫星本体坐标系的转换矩阵,为卫星在地心惯性坐标系中的位置;为深空目标在地心惯性坐标系中的位置矢量的初始估计值;
所述t时刻与相机参数向量无关的矩阵通过下述方程求解得到:
式中,表示参数估计误差,其中,为t时刻简化后的相机参数向量的初始估计值,为t时刻简化后的相机参数向量;
步骤22:根据图像误差信息,计算势函数的导数;
记图像跟踪误差为:
其中为期望的目标在图像中的坐标位置;为t时刻深空目标在图像中的实际成像坐标位置;
定义如下两个矩阵:
其中,为的前三列元素组成的矩阵,而为投影转换矩阵的前两行元素组成的矩阵;为的前三列元素组成的向量,而为投影转换矩阵的第三行元素组成的行向量;为由地心惯性坐标系到卫星本体坐标系的转换矩阵;为深空目标在地心惯性坐标系中的位置矢量;为自定义的运算符,对任意一个由元素q 1、q 2、q 3组成的三维向量,定义的运算为;
再进一步定义矩阵:
其中,和分别表示将其中参数用初始估计值代入矩阵和后得到的矩阵,表示图像跟踪误差的转置;
得到所述势函数的导数的表达式为:
式中,为以参数估计值为自变量的势函数,为t时刻简化后的相机参数向量的初始估计值;为正常数,为非常小的正常数;表示自然指数函数;符号表示偏导数;
步骤23:计算参数更新律,并计算得到参数的当前估计值;
根据下式计算矩阵:
其中,为正定对角系数矩阵;
按照下式计算当前时刻相机参数向量估计值的导数并作为参数更新律:
其中、和为合适取值的正定对角系数矩阵,为通过卫星姿态传感器测得的卫星的姿态角速度;为估计投影误差,为子步骤S21中自定义的与参数无关的矩阵的转置,为势函数的导数;
采用下式求得更新后的相机参数的估计值:
其中,表示上一时刻,表示当前时刻,表示t时刻简化后的相机参数向量的初始估计值,表示当前时刻简化后的相机参数的估计值,表示当前时刻相机参数向量估计值的导数;计算得到的将用作下个控制循环时步骤21中的相机参数向量初始估计值。
进一步的,所述步骤3包括:使用所述相机参数向量初始估计值,计算当前时刻需要输出给视频卫星的姿态控制力矩;
所述姿态控制力矩的计算公式为:
式中,为通过卫星姿态传感器测得的卫星的姿态角速度,为卫星的惯量矩阵,、分别为矩阵和的初始估计值的转置;为图像跟踪误差,表示势函数导数的绝对值;、、均为适当取值的正定对角系数矩阵。
一种存储有计算机程序的计算机可读存储介质,所述计算机程序执行时实现如上述的方法。
与现有技术相比,本发明的优点在于:
1、本发明未标定视频卫星进行深空目标观测的姿态凝视控制方法,能够在目标位置未知且相机参数存在偏差的情况下,使视频卫星有效地对深空目标进行凝视观测,且凝视观测的精度高,即可以使得即使卫星搭载的相机参数在未标定的情况下,仍然能够实现对深空目标的高精度凝视观测;
2、本发明未标定视频卫星进行深空目标观测的姿态凝视控制方法,能够对相机参数和目标位置进行在线估计,通过实时地更新参数实现对控制力矩的自适应调整,最终可以使得目标在像平面的成像能控制到期望位置。
附图说明
图1是本实施例未标定视频卫星进行深空目标观测的姿态凝视控制方法的实现流程示意图。
图2是相机坐标系及相机投影映射模型示意图。
图3是估计投影误差的变化曲线图。
图4是成像跟踪误差的变化曲线图。
图5是深空目标在图像中的成像轨迹图。
具体实施方式
以下结合说明书附图和具体优选的实施例对本发明作进一步描述,但并不因此而限制本发明的保护范围。
为清晰起见,本发明说明书中所采用符号的物理含义如下表1所示。
表1符号及其含义
本发明说明书中涉及的坐标系如下:
相机坐标系——以相机的镜头中心作为原点,轴和轴与图像边界平行,轴为相机光轴所组成的右手直角坐标系;
地心惯性坐标系——J2000坐标系,即原点在地球质心,XY平面为J2000时刻的地球平赤道面,X轴指向J2000时刻的平春分点(J2000时刻平赤道面与平黄道面的一个交点)所形成的右手直角坐标系;
卫星本体坐标系——以卫星质心为原点,以三个惯量主轴分别作为三个方向坐标轴的右手直角坐标系;
(一)流程描述
本发明针对深空目标位置信息未知条件下的观测任务,给出一种未标定视频卫星对深空目标进行观测的姿态凝视控制方法,该方法是一种基于参数未标定相机获得的图像反馈信息的自适应姿态控制方法。
如图1所示的流程,本实施例未标定视频卫星进行深空目标观测的姿态凝视控制方法包括步骤1~步骤4四个步骤:
步骤1,根据相机内部的成像模型以及相机在视频卫星上的安装位置,确定需要进行估计的相机参数向量初始估计值;
首先根据针孔成像模型,目标在像平面的成像过程可以通过相机投影转换矩阵表示,并给出此矩阵的初始估计值;然后给出深空目标在地心惯性坐标系中的位置矢量的初始估计值;最后由相机投影转换矩阵和位置矢量的值整理成t时刻简化后的相机参数向量。
步骤2,根据图像中识别到的目标的像素坐标信息以及所述相机参数向量初始估计值,利用预设的参数更新律求出当前时刻相机参数的估计值;
步骤2主要是对当前时刻t的相机参数进行循环估计。首先根据当前的时刻确定参数向量的初始估计值,然后计算估计投影误差以及矩阵;再然后跟据参数初始估计值计算所设计的势函数的导数,用于避免奇异性问题;最后将上述信息代入到参数更新律中,计算当前时刻的参数的当前估计值,并将其作为下一时刻此步骤的初始估计值。
步骤3,根据所述相机参数向量初始估计值,计算当前时刻需要输出给视频卫星的姿态控制力矩以对视频卫星的姿态进行控制;
将参数初始估计值代入到自适应姿态控制器中,得到当前时刻t需要输出给视频卫星的姿态控制力矩,实现对目标的凝视观测。
步骤4,将步骤2获得的当前时刻所述相机参数的估计值作为新的相机参数向量初始估计值,不断地重复步骤2和步骤3,以不断计算下一时刻所述相机参数的估计值以及下一时刻需要输出给视频卫星的姿态控制力矩,实现对视频卫星的姿态的控制,直至视频卫星的深空目标观测任务结束。
(二)具体流程
具体地,本发明所述姿态凝视控制方法的具体实施过程又可以细分为多个详细步骤,其中步骤11~14为步骤1包含的详细步骤,步骤21~23为步骤2包含的详细步骤。
步骤1具体包括步骤11~14:
步骤11,根据相机内部的成像模型和相机在视频卫星上的安装位置,给出相机投影转换矩阵的初始估计值;
相机内部模型描述的是目标入射光线与像平面上的坐标之间的关系。本实施例中,相机的投影映射模型采用图2所示的最常用的针孔成像模型,即入射光线穿过镜头中心到达镜头后方的传感器,然后传感器将光信号转换为电信号最后成为数字图像信息。
设为相机焦距,镜头中心光轴与像平面的交点为像平面中心。传感器由众多像素组成,假设像素的物理尺寸为。自定义矩阵:
相机在卫星本体坐标系中的安装位置矢量由表示,其在相机坐标系中的分量表示为。假设由卫星本体坐标系到相机坐标系的旋转矩阵为,则定义矩阵:
相机投影转换矩阵定义为
式中,为所述相机投影转换矩阵,为相机焦距,和分别为镜头中心光轴与像平面相交形成的像平面中心的横坐标和纵坐标,和分别为单个像素的物理长度和物理宽度;表示由卫星本体坐标系到相机坐标系的转换矩阵;表示相机在卫星本体坐标系中的安装位置矢量在相机坐标系中的分量;表示1行3列的全零行向量;
将理想状况下的物理参数(包括、、、、、和)的值代入到投影转换矩阵的表达式中,得到的即为的初始估计值,注:此处符号顶标“”表示对应参数的估计值。
步骤12,获取待观测的深空目标在地心惯性坐标系中的位置矢量的初始估计值;
所述深空目标在地心惯性坐标系中的位置矢量记为;所述深空目标在地心惯性坐标系中的位置矢量的初始估计值记为。
深空目标的位置主要通过先验知识信息得到,例如已经知道观测的目标是哪一颗恒星,可以通过查找相关资料知道其位置矢量,也可融合图像与卫星姿态等信息估算大致的目标位置。将先验知识信息或估算的信息作为深空目标位置的初始估计值。
步骤13,根据所述相机投影转换矩阵的初始估计值和所述深空目标在地心惯性坐标系中的位置矢量的初始估计值,获取得到相机参数向量;
投影转换矩阵维数为,其分量表示为,;的第k个分量为,。需要估计的参数向量定义为
式中,表示相机投影转换矩阵的第i行、第j列元素,其中,i= 1、2、3,j= 1、2、3,例如,为相机投影转换矩阵的第1行、第1列元素,为相机投影转换矩阵的第3行、第1列元素,为相机投影转换矩阵的第3行、第3列元素;表示深空目标在地心惯性坐标系中的位置矢量的第k个分量,其中,,例如,表示的第1个分量,表示的第2个分量,表示的第3个分量;为相机投影转换矩阵的第1行、第4列元素,为相机投影转换矩阵的第2行、第4列元素,为相机投影转换矩阵的第3行、第4列元素;上标T表示向量的转置;
将S1和S2给出的估计值代入到上式得到的初始估计值。
步骤14,对所述相机参数向量进行简化,得到t时刻简化后的相机参数向量的初始估计值;
理论上可知取值并不固定,其任意倍数向量(例如,为非零常实数)对相机的投影模型均无影响,所以可减少参数数量。
所述对所述相机参数向量进行简化包括:将所述相机参数向量中的元素固定设置为1,得到简化后的相机参数向量为:
式中,表示简化后的相机参数向量,表示相机投影转换矩阵的第i行、第j列元素;表示深空目标在地心惯性坐标系中的位置矢量的第k个分量;
所述t时刻简化后的相机参数向量的初始估计值为需要进行估计的相机参数向量初始估计值,通过将相机投影转换矩阵的初始估计值和深空目标在地心惯性坐标系中的位置矢量的初始估计值代入到的表达式得到。
步骤2包括步骤21~23:
步骤21:利用t时刻简化后的相机参数向量的初始估计值,计算t时刻的估计投影误差和t时刻与相机参数向量无关的矩阵;
若当前时刻为初始时刻,则采用步骤1中S4得到的参数初始估计值,若当前时刻不是初始时刻,则将上一时刻的步骤S23中得到的参数当前估计值作为此步骤的参数初始估计值。
估计投影误差用于衡量当前时刻估计的参数求出的估计目标图像的像素坐标与实际图像中像素坐标之间的差异。其按下式求出:
其中,深空目标在像平面的实际成像坐标为,而、分别为在像平面横、纵两轴上的坐标分量,由实际图像提取得到像平面上的目标成像坐标;为t时刻目标在相机坐标系轴上的分量的初始估计值;为投影转换矩阵初始估计值的前两行元素组成的矩阵;,为地心惯性坐标系到卫星本体坐标系的转换矩阵,为卫星在地心惯性坐标系中的位置;为目标位置的初始估计值。估计投影误差是与参数线性相关的。
定义参数估计误差,为参数的实际值,则估计投影误差还可表示为
矩阵按上式求解得到。
步骤22:根据图像误差信息,计算势函数的导数;
求得图像跟踪误差:
其中为我们期望的目标在图像中的位置;通常我们期望目标能够位于图像中心,以获得更好的观测效果。有如下两个矩阵:
将矩阵和中参数用初始估计值代入计算,得到的结果记为和。
再计算如下自定义矩阵的值:
为了稳定性要求,需设计势函数以保证参数更新过程中上述矩阵的秩为2。所设计的势函数的导数为:
其中为正常数,为非常小的正常数。通过上式即求得势函数的导数。
步骤23:计算参数更新律,并计算得到参数的当前估计值;
首先需要根据下式计算一个矩阵:
其中为正定对角系数矩阵。再根据前述步骤求得的数据,计算当前时刻参数更新所需的变化率:
其中、和为合适取值的正定对角系数矩阵,为通过卫星姿态传感器测得的卫星的姿态角速度。上式计算出后,可求得更新过后的参数估计值:
其中,表示前一时刻的时间,表示当前时刻,表示简化后的相机参数向量初始估计值,表示简化后的参数此时的当前估计值。在下一个控制循环中,将当前时刻的参数估计值作为到S22步骤中的,经过S21、S22、S23重新计算新的时刻参数当前估计值。
步骤3的具体过程为:
使用所述相机参数向量初始估计值,计算当前时刻需要输出给视频卫星的姿态控制力矩;
通过下式计算控制力矩:
、均为适当取值的正定对角系数矩阵,其它变量在前述步骤中均已求得。将参数的初始估计值代入到上式中得到需要输出的力矩。最终通过卫星上的反作用飞轮等姿态执行器输出对应力矩实现对卫星的控制,最终目标在相机图像中的成像会保持在期望的坐标位置。
以上是本发明所述方法的具体流程。本发明为基于未标定视频卫星的姿态控制方法,通过对相机参数的不断估计,可以对深空目标实现自适应凝视控制,使得目标的在图像中的成像保持在期望的位置。
(三)仿真分析
下面根据该方法进行仿真,并给出仿真结果。
本实施例仿真中假设目标初始状态已经处于视野中,然后利用本发明给出的姿态凝视控制方法将目标控制到期望位置。相机参数如表2所示,其中表示按照3-2-1转序转动对应角度的旋转矩阵。相机参数的理论值表示仿真中设置的理论相机模型参数,实际值是表示各种因素产生偏差后相机实际的参数,用于仿真中计算观测到的目标在像平面中的目标。
表3为仿真时控制器中所用到的各个系数值,其中表示将其中各个元素依次作为对角线上的元素,其他空置位置均为0的矩阵。
仿真以表2的相机参数理论值作为初始估计值,计算估计投影误差以及势函数的导数,然后结合表3中部分参数将初始估计值用于计算参数估计值的导数,从而对参数进行更新,得到当前时刻的参数估计值。将控制参数和相机参数估计值代入到控制器中,得到当前时刻的控制力矩并通过姿态控制执行机构输出,实现对卫星姿态的控制。以当前时刻的参数估计值作为下一个时刻的初始估计值,重复上述步骤计算下一个时刻的控制力矩。如此重复,完成对目标的凝视控制过程。
图3给出了估计投影误差的变化曲线图,展示了随着参数的不断更新,估计投影误差逐渐收敛,证明参数更新方法能够朝着正确的方向对参数进行估计。
图4给出成像跟踪误差曲线图,由图4可以看出,目标在像平面的成像坐标与我们期望的坐标位置在横纵两个方向之间的差异都逐渐收敛至0,即观测目标的成像逐渐移动到期望的坐标位置。
图5给出了目标在图像中的成像轨迹,像平面是大小为像素,观测目标为远距离天体,当识别到的目标出现在视场边缘时,自适应控制器开始介入并将目标位置控制到期望的视场中心位置。图5更直观展示了目标在图像中的成像位置从起始点逐渐移动到我们期望的终止点(即图像中心)的过程,证明了控制方法成功实现对目标的凝视控制。
上述仿真结果表明,控制器能够达到预期的控制目标,使得目标成像在期望的视场位置。目标位置未知且相机参数存在偏差的情况下,该自适应控制器能够有效地对深空目标进行凝视观测。
上述只是本发明的较佳实施例,并非对本发明作任何形式上的限制。虽然本发明已以较佳实施例揭露如上,然而并非用以限定本发明。因此,凡是未脱离本发明技术方案的内容,依据本发明技术实质对以上实施例所做的任何简单修改、等同变化及修饰,均应落在本发明技术方案保护的范围内。
Claims (7)
1.一种未标定视频卫星进行深空目标观测的姿态凝视控制方法,其特征在于,步骤包括:
步骤1,根据相机内部的成像模型以及相机在视频卫星上的安装位置,确定需要进行估计的相机参数向量初始估计值;
步骤2,根据图像中识别到的目标的像素坐标信息以及所述相机参数向量初始估计值,利用预设的参数更新律求出当前时刻相机参数的估计值;所述参数更新律为基于目标的像素坐标信息以及相机参数向量初始估计值求解得到的动态实时解算值,表达式为:
其中Γ、K1和K2均为合适取值的正定对角系数矩阵,ω(t)为通过卫星姿态传感器测得的卫星的姿态角速度;e(t)为估计投影误差,Yp(t)、Wp(t)均为t时刻与相机参数向量无关的矩阵,为势函数的导数,上标T表示矩阵的转置;
步骤3,根据所述相机参数向量初始估计值,计算当前时刻需要输出给视频卫星的姿态控制力矩以对视频卫星的姿态进行控制;
步骤4,将步骤2获得的当前时刻所述相机参数的估计值作为新的相机参数向量初始估计值,不断地重复步骤2和步骤3,以不断计算下一时刻所述相机参数的估计值以及下一时刻需要输出给视频卫星的姿态控制力矩,实现对视频卫星的姿态的控制,直至视频卫星的深空目标观测任务结束。
2.根据权利要求1所述的未标定视频卫星进行深空目标观测的姿态凝视控制方法,其特征在于,所述步骤1包括步骤11~14:
步骤11,根据相机内部的成像模型和相机在视频卫星上的安装位置,给出相机投影转换矩阵的初始估计值;
所述相机投影转换矩阵为一个3×4维的矩阵,表达式为:
式中,N为所述相机投影转换矩阵,f为相机焦距,u0和v0分别为镜头中心光轴与像平面相交形成的像平面中心的横坐标和纵坐标,dx和dy分别为单个像素的物理长度和物理宽度;表示由卫星本体坐标系到相机坐标系的转换矩阵;cRbc表示相机在卫星本体坐标系中的安装位置矢量在相机坐标系中的分量;01×3表示1行3列的全零行向量;
所述相机投影转换矩阵的初始估计值通过将理想状况下的物理参数f、u0、v0、dx、dy、和cRbc的值代入到所述相机投影转换矩阵的表达式中得到;
步骤12,获取待观测的深空目标在地心惯性坐标系中的位置矢量的初始估计值;
所述深空目标在地心惯性坐标系中的位置矢量记为iReT;所述深空目标在地心惯性坐标系中的位置矢量的初始估计值记为
步骤13,根据所述相机投影转换矩阵的初始估计值和所述深空目标在地心惯性坐标系中的位置矢量的初始估计值获取得到相机参数向量θ;
所述相机参数向量θ定义为:
θ=(nijxk n14 n24 n34)T i,j,k=1,2,3
式中,nij表示相机投影转换矩阵N的第i行、第j列元素,其中,i=1、2、3,j=1、2、3,xk表示深空目标在地心惯性坐标系中的位置矢量iReT的第k个分量,其中,k=1,2,3;n14为相机投影转换矩阵N的第1行、第4列元素,n24为相机投影转换矩阵N的第2行、第4列元素,n34为相机投影转换矩阵N的第3行、第4列元素;上标T表示向量的转置;
步骤14,对所述相机参数向量θ进行简化,得到t时刻简化后的相机参数向量的初始估计值
所述对所述相机参数向量θ进行简化包括:将所述相机参数向量θ中的元素n33x3固定设置为1,得到简化后的相机参数向量θp为:
θp=(nijxk n31x1 n31x2 n31x3 n32x1 n32x2 n32x3 n33x1 n33x2 n14 n24 n34)T
i=1,2j,k=1,2,3
式中,θp表示简化后的相机参数向量,nij表示相机投影转换矩阵N的第i行、第j列元素;xk表示深空目标在地心惯性坐标系中的位置矢量iReT的第k个分量;
所述t时刻简化后的相机参数向量的初始估计值为需要进行估计的相机参数向量初始估计值,通过将相机投影转换矩阵的初始估计值和深空目标在地心惯性坐标系中的位置矢量的初始估计值代入到θp的表达式得到。
3.根据权利要求2所述的未标定视频卫星进行深空目标观测的姿态凝视控制方法,其特征在于,所述步骤12中,相机内部的成像模型采用针孔成像模型。
4.根据权利要求2所述的未标定视频卫星进行深空目标观测的姿态凝视控制方法,其特征在于,所述步骤12中,深空目标在地心惯性坐标系中的位置矢量的初始估计值通过先验知识信息或融合已知信息估算得到。
5.根据权利要求1~4中任意一项所述的未标定视频卫星进行深空目标观测的姿态凝视控制方法,其特征在于,所述步骤2包括步骤21~23:
步骤21:利用t时刻简化后的相机参数向量的初始估计值计算t时刻的估计投影误差e(t)和t时刻与相机参数向量无关的矩阵Wp(t);
所述t时刻的估计投影误差e(t)的表达式为:
式中,为t时刻目标在相机坐标系z轴上的分量的初始估计值;y(t)=(u,v)T为深空目标T在像平面的实际成像坐标,其中u、v分别为在像平面横、纵两轴上的坐标分量,由实际图像提取得到像平面上的目标成像坐标;为投影转换矩阵初始估计值的前两行元素组成的矩阵;Th为自定义矩阵,其中,为地心惯性坐标系到卫星本体坐标系的转换矩阵,iReb为卫星在地心惯性坐标系中的位置;为深空目标在地心惯性坐标系中的位置矢量的初始估计值;
所述t时刻与相机参数向量无关的矩阵Wp(t)通过下述方程求解得到:
Wp(t)Δθp(t)=e(t)
式中,表示参数估计误差,其中,为t时刻简化后的相机参数向量的初始估计值,θp为t时刻简化后的相机参数向量;
步骤22:根据图像误差信息,计算势函数的导数
记图像跟踪误差Δy(t)为:
Δy(t)=y(t)-yd
其中yd为期望的目标在图像中的坐标位置;y(t)为t时刻深空目标T在图像中的实际成像坐标位置;
定义如下两个矩阵:
其中,P(3)为P的前三列元素组成的矩阵,而P为投影转换矩阵N的前两行元素组成的矩阵;为的前三列元素组成的向量,而为投影转换矩阵N的第三行元素组成的行向量;为由地心惯性坐标系到卫星本体坐标系的转换矩阵;iReT为深空目标在地心惯性坐标系中的位置矢量;sk为自定义的运算符,对任意一个由元素q1、q2、q3组成的三维向量q,sk定义的运算为
再进一步定义矩阵G(t):
其中,和分别表示将其中参数用初始估计值代入矩阵和后得到的矩阵,ΔyT(t)表示图像跟踪误差的转置;
得到所述势函数的导数的表达式为:
式中,为以参数估计值为自变量的势函数,为t时刻简化后的相机参数向量的初始估计值;a为正常数,b为非常小的正常数;e表示自然指数函数;符号表示偏导数;
步骤23:计算参数更新律并计算得到参数的当前估计值
根据下式计算矩阵Yp(t):
其中,B为正定对角系数矩阵;
按照下式计算当前时刻相机参数向量估计值的导数并作为参数更新律:
采用下式求得更新后的相机参数的估计值:
其中,tk-1表示上一时刻,tk表示当前时刻,表示t时刻简化后的相机参数向量的初始估计值,表示当前时刻简化后的相机参数的估计值,表示当前时刻相机参数向量估计值的导数;计算得到的将用作下个控制循环时步骤21中的相机参数向量初始估计值。
6.根据权利要求1~4中任意一项所述的未标定视频卫星进行深空目标观测的姿态凝视控制方法,其特征在于,所述步骤3包括:
使用所述相机参数向量初始估计值,计算当前时刻需要输出给视频卫星的姿态控制力矩τ(t);
所述姿态控制力矩τ(t)的计算公式为:
式中,w(t)为通过卫星姿态传感器测得的卫星的姿态角速度,J为卫星的惯量矩阵, 分别为矩阵和的初始估计值的转置;Δy(t)为图像跟踪误差,表示势函数导数的绝对值;B、K3、K4均为适当取值的正定对角系数矩阵。
7.一种存储有计算机程序的计算机可读存储介质,其特征在于,所述计算机程序执行时实现如权利要求1~6中任意一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210487940.2A CN114877871B (zh) | 2022-05-06 | 2022-05-06 | 未标定视频卫星进行深空目标观测的姿态凝视控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210487940.2A CN114877871B (zh) | 2022-05-06 | 2022-05-06 | 未标定视频卫星进行深空目标观测的姿态凝视控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114877871A CN114877871A (zh) | 2022-08-09 |
CN114877871B true CN114877871B (zh) | 2024-01-09 |
Family
ID=82674300
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210487940.2A Active CN114877871B (zh) | 2022-05-06 | 2022-05-06 | 未标定视频卫星进行深空目标观测的姿态凝视控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114877871B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116883625B (zh) * | 2023-06-09 | 2024-03-22 | 江苏泽景汽车电子股份有限公司 | 一种图像展示方法、装置、电子设备及存储介质 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015141159A (ja) * | 2014-01-30 | 2015-08-03 | 三菱電機株式会社 | 画像ナビゲーション装置、衛星および画像ナビゲーション方法 |
CN105698764A (zh) * | 2016-01-30 | 2016-06-22 | 武汉大学 | 一种光学遥感卫星影像时变系统误差建模补偿方法及系统 |
CN106885585A (zh) * | 2016-12-30 | 2017-06-23 | 国家测绘地理信息局卫星测绘应用中心 | 一种基于光束法平差的星载摄影测量系统一体化检校方法 |
CN107101648A (zh) * | 2017-04-26 | 2017-08-29 | 武汉大学 | 基于区域网内恒星影像的星相机定标定姿方法及系统 |
CN110007324A (zh) * | 2019-02-21 | 2019-07-12 | 南京航空航天大学 | 一种基于slam的故障卫星相对导航方法 |
US10782418B1 (en) * | 2019-11-28 | 2020-09-22 | Beihang University | Calculation method for visual navigation integrity monitoring |
CN112660423A (zh) * | 2020-12-17 | 2021-04-16 | 中国人民解放军国防科技大学 | 一种视频卫星对运动目标的凝视跟踪控制方法及系统 |
CN113781579A (zh) * | 2021-09-10 | 2021-12-10 | 浙江大学 | 一种全景红外相机几何标定方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7421151B2 (en) * | 2004-05-18 | 2008-09-02 | Orbimage Si Opco Inc. | Estimation of coefficients for a rational polynomial camera model |
-
2022
- 2022-05-06 CN CN202210487940.2A patent/CN114877871B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015141159A (ja) * | 2014-01-30 | 2015-08-03 | 三菱電機株式会社 | 画像ナビゲーション装置、衛星および画像ナビゲーション方法 |
CN105698764A (zh) * | 2016-01-30 | 2016-06-22 | 武汉大学 | 一种光学遥感卫星影像时变系统误差建模补偿方法及系统 |
CN106885585A (zh) * | 2016-12-30 | 2017-06-23 | 国家测绘地理信息局卫星测绘应用中心 | 一种基于光束法平差的星载摄影测量系统一体化检校方法 |
CN107101648A (zh) * | 2017-04-26 | 2017-08-29 | 武汉大学 | 基于区域网内恒星影像的星相机定标定姿方法及系统 |
CN110007324A (zh) * | 2019-02-21 | 2019-07-12 | 南京航空航天大学 | 一种基于slam的故障卫星相对导航方法 |
US10782418B1 (en) * | 2019-11-28 | 2020-09-22 | Beihang University | Calculation method for visual navigation integrity monitoring |
CN112660423A (zh) * | 2020-12-17 | 2021-04-16 | 中国人民解放军国防科技大学 | 一种视频卫星对运动目标的凝视跟踪控制方法及系统 |
CN113781579A (zh) * | 2021-09-10 | 2021-12-10 | 浙江大学 | 一种全景红外相机几何标定方法 |
Non-Patent Citations (1)
Title |
---|
高分六号宽幅相机在轨几何定标及精度验证;王密 等;《测绘学报》;第49卷(第2期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114877871A (zh) | 2022-08-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110390697B (zh) | 一种基于lm算法的毫米波雷达与摄像头联合标定方法 | |
Wei et al. | Star sensor calibration based on integrated modelling with intrinsic and extrinsic parameters | |
CN107192376B (zh) | 基于帧间连续性的无人机多帧图像目标定位校正方法 | |
CN103697864B (zh) | 一种基于大虚拟相机的窄视场双相机影像拼接方法 | |
CN106054910B (zh) | 视场方向可调的卫星对地凝视姿态控制方法 | |
CN109782810B (zh) | 基于图像引导的视频卫星运动目标跟踪成像方法及其装置 | |
CN114877871B (zh) | 未标定视频卫星进行深空目标观测的姿态凝视控制方法 | |
CN112435301A (zh) | 一种基于恒星轨迹的遥感相机在轨几何定标方法 | |
CN107085856B (zh) | 一种基于光学影像的在轨高精度实时定位方法 | |
US9794483B1 (en) | Video geolocation | |
CN105196292A (zh) | 一种基于迭代变时长视觉伺服控制方法 | |
Zhou et al. | Novel autonomous on-orbit calibration method for star sensors | |
CN114758011B (zh) | 融合离线标定结果的变焦相机在线标定方法 | |
CN110223233B (zh) | 一种基于图像拼接的无人机航拍建图方法 | |
CN115618749A (zh) | 一种大型无人机实时定位的误差补偿方法 | |
CN114659523A (zh) | 一种大范围高精度姿态测量方法及装置 | |
CN113436267A (zh) | 视觉惯导标定方法、装置、计算机设备和存储介质 | |
CN112816184A (zh) | 一种光学遥感卫星的无控定标方法及装置 | |
CN114280773B (zh) | 天文望远镜校准方法及装置 | |
CN114838739A (zh) | 一种考虑完整回归周期的卫星图像几何定标方法 | |
CN115689915A (zh) | 一种基于二维勒让德神经网络实现在轨星图几何畸变校正方法及星敏感器 | |
CN113487677A (zh) | 一种基于任意分布式配置的多ptz相机的室外中远距场景标定方法 | |
Kinoshita et al. | Simultaneous determination of camera pose and intrinsic parameters by visual servoing | |
CN113034610B (zh) | 一种基于天文技术的空间指向测量仪器标定方法 | |
CN116091546B (zh) | 光学相机推扫模式下的观测构建方法 |
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 |