CN114296069A - 一种基于视觉雷达的小天体探测器多模型导航方法 - Google Patents
一种基于视觉雷达的小天体探测器多模型导航方法 Download PDFInfo
- Publication number
- CN114296069A CN114296069A CN202111591545.0A CN202111591545A CN114296069A CN 114296069 A CN114296069 A CN 114296069A CN 202111591545 A CN202111591545 A CN 202111591545A CN 114296069 A CN114296069 A CN 114296069A
- Authority
- CN
- China
- Prior art keywords
- detector
- flexible
- model
- navigation
- celestial body
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 55
- 230000000007 visual effect Effects 0.000 title claims abstract description 25
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 32
- 238000001914 filtration Methods 0.000 claims abstract description 21
- 239000000463 material Substances 0.000 claims abstract description 21
- 230000008878 coupling Effects 0.000 claims abstract description 17
- 238000010168 coupling process Methods 0.000 claims abstract description 17
- 238000005859 coupling reaction Methods 0.000 claims abstract description 17
- 230000003993 interaction Effects 0.000 claims description 19
- 230000004927 fusion Effects 0.000 claims description 16
- 239000011159 matrix material Substances 0.000 claims description 16
- 238000001514 detection method Methods 0.000 claims description 13
- 230000008569 process Effects 0.000 claims description 13
- 230000007704 transition Effects 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 9
- 238000010586 diagram Methods 0.000 claims description 6
- 238000005312 nonlinear dynamic Methods 0.000 claims description 6
- 230000010354 integration Effects 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000013016 damping Methods 0.000 claims description 3
- 230000005489 elastic deformation Effects 0.000 claims description 3
- 239000000523 sample Substances 0.000 description 7
- 238000004088 simulation Methods 0.000 description 5
- 230000002452 interceptive effect Effects 0.000 description 3
- XUIMIQQOPSSXEZ-UHFFFAOYSA-N Silicon Chemical compound [Si] XUIMIQQOPSSXEZ-UHFFFAOYSA-N 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 239000012535 impurity Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 229910052710 silicon Inorganic materials 0.000 description 2
- 239000010703 silicon Substances 0.000 description 2
- 229920002379 silicone rubber Polymers 0.000 description 2
- 238000000342 Monte Carlo simulation Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
Images
Classifications
-
- 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
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/10—Information and communication technologies [ICT] supporting adaptation to climate change, e.g. for weather forecasting or climate simulation
Landscapes
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种基于视觉雷达的小天体探测器柔性多模型导航方法,以解决探测器附着小天体时刚性碰撞问题,提高导航精度。本发明实现方法为:首先将柔性材料和探测器结合,构成柔性探测器物理模型,并根据柔性材料的刚柔耦合特性,构建动力学模型;随后将视觉雷达数据融合,完成视觉/雷达结合导航滤波;最后运用航迹关联算法和小天体柔性探测器多模型滤波算法,实现在柔性多模型下,柔性探测器对小天体表面的附着导航。本方案根据柔性材料在不同柔变系数下的柔性多模型,将柔性材料与多模型滤波算法结合,提高导航精度。
Description
技术领域
本发明属于深空探测器自主导航领域,特别适用于深空探测器跟踪附着小天体的过程,具体涉及一种基于视觉雷达的小天体探测器柔性多模型导航方法。
背景技术
近年来,深空探测不断发展,小天体探测也已经成为一项艰巨且具有科学意义的深空探测任务。然而,与行星探测任务相比,小天体探测任务具有探测目标小、所处环境多变、引力小、着陆点不规则等特点。当前小天体探测器在进行小天体附着时,由于单个探测器、单一传感器的限制,以及对目标运动模型建模的不确定,导致探测器无法准确跟踪小天体;由于探测器与小天体接触时发生刚性碰撞,导致小天体探测器附着时发生反弹而失败,探测器无法准确附着小天体,不能完成小天体样品采集的任务。
柔性材料发展迅速,柔性材料以其刚柔耦合特性,成为一种极具应用前景的航天探测器材料。但是,柔性材料有复杂的非线性特性,这使得柔性材料结构复杂且极易受到扰动。将雷达与视觉导航方法结合,提高导航精度,增强准确性;与此同时,运用多模型交互导航的方式,引入柔性探测器的不同动力学模型,将柔性材料与多模型交互导航算法结合,增强组合导航的可靠性的同时,大大加强了探测器附着小天体成功的概率。交互式多模型算法作为一种常见的数据融合算法,精度高,可靠性强,用于深空小天体探测任务,与组合导航算法和新型的柔性材料结合,完成深空探测任务,国内对该方面的研究仍在不断进行中。
发明内容
本发明的目的是解决小天体跟踪精度低、小天体与探测器刚性碰撞导致附着失败等问题,提出了一种基于视觉雷达小天体多模型柔性探测器导航方法。将视觉/雷达探测器与柔性材料相结合,建立小天体柔性探测器物理模型;同时根据柔性材料的刚柔耦合特性,建立不同位置状态下的多种简化动力学模型;研究视觉/雷达数据融合目标导航算法,设计了将视觉和雷达信息作为观测量的卡尔曼滤波器,基于该滤波器和不同状态下的动力学模型,运用了一种视觉/雷达的多模型导航算方法,提高导航精度,进而解决柔性探测器在小天体表面附着等方面问题。
本发明是通过下述技术方案实现的。
本发明公开的柔性探测器多模型导航方法,根据刚柔耦合特性对柔性探测器上的多个探测器点建立多种动力学观测模型,将视觉雷达融合信息作为输入量,引入多种动力学模型,实现整体柔性探测器对小天体表面特征点的导航:将视觉/雷达探测器与柔性材料相结合,建立柔性探测器物理模型;基于柔性体的刚柔耦合特性建立不同位置状态下的多种动力学模型;运用视觉/雷达数据融合目标跟踪算法,提出了将视觉和雷达信息作为观测量的卡尔曼滤波器,基于该滤波器和不同状态下柔性探测器的动力学模型,提出了一种视觉/雷达的小天体柔性探测器多模型导航方法,提高导航精度,进而解决柔性探测器在小天体表面附着等方面问题。
本发明公开的一种基于视觉雷达的小天体探测器柔性多模型导航方法,包括以下步骤:
步骤一、搭建柔性探测器物理模型:
将柔性材料与探测装置结合,设每个质量聚集体为一个节点,可以设置N个节点。其中柔性材料基本由硅橡胶与有机硅组成,根据材料构成不同,柔性材料有不同的柔变系数;每个探测装置由视觉相机、激光雷达组成,用于定位与导航。
步骤二、构建柔性探测器动力学模型:
根据柔性探测器的刚柔耦合特性,将柔性探测器节点之间的连接等效为弹性连接,得到探测器节点的非线性动力学模型。
本发明采用混合坐标系法,其中包括描述单个节点与着陆点处的距离、姿态倾斜角关系的聚集体平动系o-xi-yi-zi(i=1,2,...,N)和描述整个柔性探测器与着陆点处地面的距离、姿态倾斜角关系的柔性探测器平动系ot-xt-yt-zt,其中,i表示为柔性探测器上第i个探测器节点。
柔性探测器节点绕x轴转过的角度为θ,则其转动角速度与角加速度可分别表示为和记聚集体平动系原点在柔性探测器平动系下的位置矢量为r0,记聚集体平动系到柔性探测器平动系的空间转换矩阵为A。可得柔性探测器中的第i个探测器节点在柔性探测器平动系下的位置矢量Ri为:
Ri=r0+A(ri+Nq)
其中,ri为节点i在聚集体平动系下未发生运动前的位置矢量,Nq为节点i在聚集体平动系下的弹性变形。从而,节点i在柔性探测器平动系下的速度与加速度分别为:
单元动能可表示为:
对单元动能进行变分,并在时间上进行积分,通过哈密顿原理得到柔性探测器节点间刚柔耦合非线性动力学模型为:
其中,C为阻尼等效矩阵,G为刚柔耦合引起的附加质量矩阵,M为节点质量矩阵,QT为刚性运动加速度引起的外载荷,QΠ为预应变产生的载荷列阵。
柔性探测器节点在不同位置下,建立不同刚柔耦合非线性模型,得到各个柔性探测器节点的独立状态方程和独立观测方程。
步骤三、通过视觉/雷达目标导航算法进行单模型探测器导航:
通过柔性探测器搭载相机拍摄的图像进行解算得到目标的深度信息,雷达信息经过杂质过滤,将视觉信息与雷达数据进行数据融合,设计一种将融合后的像素坐标作为观测量的卡尔曼滤波,将融合结果输入到滤波器中,得到目标特征点的位置估计,原理如图4所示。
其中,针对传统的视觉/雷达融合的目标导航方法,即将视觉与雷达解算的位置信息直接作为卡尔曼滤波的观测量的方法,视觉解算结果误差为非高斯白噪声,导致滤波精度不高,所以提出了一种将像素坐标作为观测量的视觉/雷达信息融合的卡尔曼滤波器,以提高目标跟踪精度。
将柔性探测器节点的状态变量选取为:
X=[x,y,z,Vx,Vy,Vz,ax,ay,az]T
其中,x,y,z为跟踪目标的位置信息,Vx,Vy,Vz为跟踪目标三个方向的速度分量,ax,ay,az为跟踪目标三个方向的加速度信息。
则其目标状态方程为:
X(k+1)=ΦX(k)+ΓW(k)
其中Φ为状态转移矩阵,G为过程噪声矩阵,W为过程噪声。观测方程为:
其中,(u1,v1)与(u2,v2)分别为柔性探测器节点1与柔性探测器节点2搭载相机拍摄到目标天体部分特征点的像素坐标,(xr,yr,zr)为雷达测量到的小天体目标特征点的三维坐标。
步骤四、运用最近临界法进行特征点关联:
雷达和视觉方法采集的小天体表面的数据复杂,其中包括不同的特征点和干扰数据,本发明采用最近临界法进行特征点匹配和关联,提高探测器对小天体表面数据采集的准确度。
其中,假设检测到小天体表面的特征点有c个类别ω1,ω2,…,ωc,每类有Ni(i=1,2,…c)个标明类别的样本。则规定ωi类的判别函数为:
其中,i表示ωi类,k表示ωi类Ni个样本中的第k个。
最近邻法应用到小天体表面多目标导航系统中的过程如图5所示。假设存在三个小天体目标特征点,相应传感器在各时刻分别可以得到三组数据(ax(t),ay(t),az(t))、(bx(t),by(t),bz(t))与(cx(t),cy(t),cz(t)),将属于同一类的数据串联起来。
步骤五、进行柔性探测器多模型轨迹导航:
步骤三运用的是单一模型的导航算法,现在运用多模型算法,根据各个柔性探测器节点之间的位置参数不同,得到的不同动力学模型,将各种状态下的模型引入系统中,使各个运动模型尽可能准确的描述柔性探测器不同的运动状态,经过输入交互、状态滤波、模型概率更新和状态融合输出四个步骤,完成精确导航。多模型算法原理如图6所示。
本发明采用多模型算法将柔性探测器的各种运动模型引入系统中,使各个运动模型尽可能准确的描述柔性探测器的运动状态。
多模型算法主要包括输入交互、状态滤波、模型概率更新和状态融合四个步骤。通过输入交互,可以得到系统内每一个运动模型滤波器的初始状态以及初始状态协方差的估计值,将通过输入交互得到的估计值作为各自模型滤波器的输入值将通过输入交互得到的初始状态估计值与初始状态协方差估计值作为滤波器当前输入,估计出下一时刻的状态与状态协方差;经过滤波器更新后,可以得到第j个滤波器的新息和新息协方差,结合预测模型转移概率μij(k+1∣k),可以得到当前时刻的模型概率估计;将求得的模型概率作为加权值,将状态估计与状态协方差估计的加权和作为整个算法的最终输出值:
通过上述过程可以分别得到各个柔性探测器节点对目标小天体表面特征点的导航信息,将这些信息经过卡尔曼滤波器可实现对各轨迹的融合,得到最终的导航轨迹估计信息。
与现有技术相比,本发明的优点和积极效果在于:
1、本发明公开的一种视觉雷达的小天体探测器柔性多模型导航方法,将探测器柔性化,根据柔性材料的柔变系数不同,将柔性体内力、内力矩等效为弹簧、扭簧、阻尼器的作用力及力矩,建立各个探测器之间的不同动力学模型,将视觉与雷达信息进行融合,将融合后的数据作为卡尔曼滤波的输入之一,用于导航轨迹预测,提高导航精度。
2、本发明公开的一种视觉雷达的小天体探测器柔性多模型导航方法,利用雷达和视觉得到的小天体特征点和各个探测器节点的位置信息,引入不同位置下不同的柔性探测器模型,各个探测器之间数据交互,得到不同的观测方程,通过滤波,提高对小天体表面特征点导航的准确性,完成探测器对小天体表面的着陆导航。
附图说明
图1为本发明的总体流程图;
图2为本发明柔性探测器物理模型俯视图;
图3为本发明柔性探测器物理模型仰视图;
图4为本本发明的视觉雷达单一模型跟踪原理示意图;
图5为本发明航迹关联算法示意图;
图6为本发明多模型算法示意图;
图7为本发明仿真轨迹图;
图8为本发明仿真位置误差图;
图9为本发明多模型概率估计曲线。
具体实施方式
为了能够更加清楚地理解本发明的目的、特征和优点,下面结合附图及实例对本发明做进一步说明。在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是,本发明还可以采用不同于在此描述的其他方式来实施,因此,本发明并不限于下面公开的具体实施例。
一种基于视觉雷达的小天体探测器柔性多模型导航方法,包括以下步骤:
步骤一、构建柔性探测器物理模型;
步骤二、构建柔性探测器动力学模型;
步骤三、通过视觉/雷达目标导航算法进行单模型柔性探测器导航;
步骤四、运用最近临界法进行特征点关联;
步骤五、进行多模型轨迹导航。
具体的:
步骤一、构建柔性探测器物理模型:
本发明将柔性材料与探测装置结合,每个探测装置为一个节点,以4个探测节点为例。其中柔性材料基本由硅橡胶与有机硅组成,根据材料不同,柔性材料有不同的柔变系数;每个探测装置由视觉相机、激光雷达成,用于定位与导航,柔性探测器物理模型结构俯视和仰视图如图2和图3所示。
步骤二、构建柔性探测器动力学模型:
将探测器节点之间的连接等效为弹性连接,根据柔性探测器的刚柔耦合特性,得到探测器节点的非线性动力学模型。
本发明采用混合坐标系法,其中包括描述单个节点与着陆点处的距离、姿态倾斜角关系的聚集体平动系o-xi-yi-zi(i=1,2,...,N)和描述整个柔性探测器与着陆点处地面的距离、姿态倾斜角关系的探测器平动系ot-xt-yt-zt,其中i为柔性探测器上不同的探测器节点。
柔性探测器节点绕x轴转过的角度为θ,转动角速度与角加速度分别为和记聚集体平动系原点在柔性探测器平动系下的位置矢量为r0,记聚集体平动系到柔性探测器平动系的空间转换矩阵为A。可得柔性探测器中的第i个柔性探测器节点在柔性探测器平动系下的位置矢量Ri为:
Ri=r0+A(ri+Nq)
其中,ri为节点i在聚集体平动系下未发生运动前的位置矢量,Nq为节点i在聚集体平动系下的弹性变形。从而,节点i在柔性探测器平动系下的速度与加速度分别为:
单元动能可表示为:
对单元动能进行变分,并在时间上进行积分,通过哈密顿原理得到柔性探测器节点间刚柔耦合非线性动力学模型为:
其中,C为阻尼等效矩阵,G为刚柔耦合引起的附加质量矩阵,M为节点质量矩阵,QT为刚性运动加速度引起的外载荷,QΠ为预应变产生的载荷列阵。根据刚柔耦合非线性模型,得到各个探测器节点的独立状态方程和独立观测模型。
步骤三、通过视觉/雷达目标导航算法进行单模型柔性探测器导航:
通过探测器搭载相机拍摄的图像进行解算得到目标的数据信息,雷达信息经过杂质过滤,将视觉信息与雷达数据进行数据融合,设计一种将融合后的像素坐标作为观测量的卡尔曼滤波,将融合结果输入到滤波器中,得到目标特征点的位置估计,原理如图4所示。
其中,针对传统的视觉/雷达融合的目标导航方法,即将视觉与雷达解算的位置信息直接作为卡尔曼滤波的观测量的方法,视觉解算结果误差为非高斯白噪声,导致滤波精度不高,所以提出了一种将融合后的像素坐标作为观测量的视觉/雷达信息融合的卡尔曼滤波器,以提高目标跟踪精度。
将柔性探测器节点的状态变量选取为:
X=[x,y,z,Vx,Vy,Vz,ax,ay,az]T
其中,x,y,z为跟踪目标的位置信息,Vx,Vy,Vz为跟踪目标三个方向的速度分量,ax,ay,az为跟踪目标三个方向的加速度信息。
则其目标状态方程为:
X(k+1)=ΦX(k)+ΓW(k)
其中Φ为状态转移矩阵,G为过程噪声矩阵,W为过程噪声,观测方程为:
其中,(u1,v1)与(u2,v2)分别为探测器节点1与探测器节点2搭载相机拍摄到目标天体部分特征点的像素坐标,(xr,yr,zr)为雷达测量到的小天体目标特征点的三维坐标。
步骤四、运用最近临界法进行特征点关联;
雷达和视觉采集的小天体表面的数据信息复杂,其中包括不同的特征点和干扰数据,本发明采用最近临界法进行特征点匹配和关联,提高探测器对小天体表面数据采集的准确度。
其中,假设检测到小天体表面有c个类别ω1,ω2,…,ωc,每类有Ni(i=1,2,…c)个标明类别的样本。则规定ωi类的判别函数为:
其中,i表示ωi类,k表示ωi类Ni个样本中的第k个。
最近邻法应用到小天体表面多目标导航系统中的过程如图5所示。假设存在三个小天体目标特征点,相应传感器在各时刻分别可以得到三组数据(ax(t),ay(t),az(t))、(bx(t),by(t),bz(t))与(cx(t),cy(t),cz(t)),将属于同一类的数据串联起来。
步骤五、进行多模型轨迹导航:
步骤三运用的是单一模型的跟踪算法,现在运用多模型算法将柔性探测器节点不同受力情况下的运动模型引入系统中,使各个运动模型可以尽可能准确的描述各柔性探测器节点的运动状态,经过输入交互、状态滤波、模型概率更新和状态融合输出四个步骤,得到各探测器点的最终运动轨迹,算法详细原理如图6所示。
采用多模型算法将柔性探测器节点的各种运动模型引入系统中,尽可能准确的描述柔性探测器节点的运动状态。
多模型算法主要包括输入交互、状态滤波、模型概率更新和状态融合四个步骤。具体过程如下:
输入交互:通过输入交互,可以得到系统内每一个运动模型滤波器的初始状态以及初始状态协方差的估计值,将通过输入交互得到的估计值作为各自模型滤波器的输入值。输入交互主要包括状态交互与状态协方差交互两个方面。
状态交互:
状态协方差交互:
预测:
滤波增益计算:
状态更新:
模型概率更新:经过滤波器更新后,可以得到第j个滤波器的新息和新息协方差,结合预测模型转移概率μij(k+1∣k),可以得到当前时刻的模型概率估计。
新息和新息协方差:
模型概率更新:
其中,πij为模型i转移到模型j的转移概率。
状态融合输出:将求得的模型概率作为加权值,将状态估计与状态协方差估计的加权和作为整个算法的最终输出值。
通过上述过程可以分别得到各个探测器节点对小天体目标表面特征点的导航信息,控制柔性探测器整体导航附着小天体。
为验证本方法的有效性,以三个柔性探测器节点为例,对小天体表面一个特征点进行导航估计,通过模型受力分析,设定模型一(M1)为匀速运动,模型二(M2)为顺时针运动,模型三(M3)为逆时针运动。
其中模型一:
模型二与模型三:
假设各柔性探测器节点的运动仿真条件如表1所示,小天体目标在1~150s、251~400s做匀速直线运动,151~250s以的速度做顺时针运动,以的速度401~500s做逆时针运动。在上述仿真条件下进行100次蒙特卡洛仿真,得到柔性探测器对小天体目标特征点的导航曲线、位置误差、模型概率估计曲线等,仿真结果如图7至9所示。
探测器节点运动仿真条件:
表1
从图7可以看出,该方法可以实现对小天体表面特征点的有效导航,从图8的位置误差图可以看出,该算法在三个方向的误差均小于1.5米,根据图9的模型概率更新来看,本发明提出的方法可以对模型改变做出及时响应,精度更高,可靠性更强。
以上所述,仅为本发明的较佳实例,并非是对本发明做其他限制,任何熟悉本专业的技术人员可能利用上述揭示的技术内容加以变更或改型为等同变化的等效实施例应用于其它领域,但是凡是未脱离本发明技术方案内容,依据本发明的技术实质对以上实施例所做的任何修改、等同变化与改型,仍属于本发明技术方案的保护范围。
Claims (3)
1.一种基于视觉雷达的小天体探测器柔性多模型导航方法,包括以下步骤:
步骤一、每个探测装置由视觉相机、激光雷达组成,搭建柔性探测器物理模型,用于定位与导航;
步骤二、根据柔性材料的刚柔特性,将探测器节点之间的耦合力等效为弹性连接,利用探测器节点之间的不同位置关系,建立不同参数下的非线性动力学模型,构建柔性探测器动力学模型;
步骤三、将视觉信息与雷达数据进行数据融合,设计一种将融合后的像素坐标作为观测量的卡尔曼滤波,将融合结果输入到滤波器中,得到目标特征点的位置估计,通过视觉/雷达目标导航算法进行探测器导航;
步骤四、采用最近临界法进行特征点匹配和关联,将同一特征点的数据串联,剔除无用干扰数据,提高导航精确度,运用最近临界法进行特征点关联;
步骤五、多个探测器节点不同柔性参数下的多种模型交互,进行多模型轨迹导航,提高导航的精确度。
2.根据权利要求1所述的一种基于视觉雷达的小天体探测器柔性多模型导航方法,其特征在于,所述步骤二中,在构建动力学模型时,采用混合坐标法:
本发明采用混合坐标系法,其中包括描述单个节点与着陆点处的距离、姿态倾斜角关系的聚集体平动系o-xi-yi-zi(i=1,2,...,N)和描述整个柔性探测器与着陆点处地面的距离、姿态倾斜角关系的柔性探测器平动系ot-xt-yt-zt,其中,i为柔性探测器上不同的探测器节点;
探测器节点绕x轴转过的角度为θ,因此其转动角速度与角加速度可分别表示为和聚集体平动系原点在探测器平动系下的位置矢量为r0,聚集体平动系到探测器平动系的空间装换矩阵为A;可得柔性探测器中的第i个探测器节点在探测器平动系下的位置矢量Ri为:
Ri=r0+A(ri+Nq)
其中,ri为节点i在聚集体平动系下未发生运动前的位置矢量,Nq为节点i在聚集体平动系下的弹性变形,从而,节点i在探测器平动系下的速度与加速度分别为:
探测器节点动能可表示为:
对探测器节点动能进行变分,并在时间上进行积分,通过哈密顿原理得到柔性探测器节点间刚柔耦合非线性动力学模型为:
其中,C为阻尼等效矩阵,G为刚柔耦合引起的附加质量矩阵,M为节点质量矩阵,QT为刚性运动加速度引起的外载荷,Q∏为预应变产生的载荷列阵,探测器节点在不同位置下,建立不同刚柔耦合非线性模型,得到各个探测器节点的独立状态方程和独立观测模型。
3.根据权利要求1所述的一种基于视觉雷达小天体多模型柔性探测器导航方法,其特征在于,所述步骤五中,在进行柔性探测器轨迹整合时,将柔性探测器在不同位置状态不同柔变系数下的多模型算法引入轨迹整合过程,多模型算法详细示意图如图6所示,具体如下:
多模型算法主要包括输入交互、状态滤波、模型概率更新和状态融合四个步骤,通过输入交互,可以得到系统内每一个运动模型滤波器的初始状态以及初始状态协方差的估计值,将通过输入交互得到的估计值作为各自模型滤波器的输入值将通过输入交互得到的初始状态估计值与初始状态协方差估计值作为滤波器当前输入,估计出下一时刻的状态与状态协方差;经过滤波器更新后,可以得到第j个滤波器的新息和新息协方差,结合预测模型转移概率μij(k+1∣k),可以得到当前时刻的模型概率估计;将求得的模型概率作为加权值,将状态估计与状态协方差估计的加权和作为整个算法的最终输出值:
通过上述过程可以分别得到柔性探测器各个探测节点对目标小天体表面特征点的导航信息,将这些信息经过卡尔曼滤波器可实现对各轨迹的融合,得到最终的导航轨迹估计信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111591545.0A CN114296069B (zh) | 2021-12-23 | 2021-12-23 | 一种基于视觉雷达的小天体探测器多模型导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111591545.0A CN114296069B (zh) | 2021-12-23 | 2021-12-23 | 一种基于视觉雷达的小天体探测器多模型导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114296069A true CN114296069A (zh) | 2022-04-08 |
CN114296069B CN114296069B (zh) | 2024-05-28 |
Family
ID=80969375
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111591545.0A Active CN114296069B (zh) | 2021-12-23 | 2021-12-23 | 一种基于视觉雷达的小天体探测器多模型导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114296069B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115246491A (zh) * | 2022-07-22 | 2022-10-28 | 北京理工大学 | 小天体柔性附着协同制导方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006104552A1 (en) * | 2005-03-29 | 2006-10-05 | Honeywell International Inc. | Method and apparatus for high accuracy relative motion determinatation using inertial sensors |
CN107132542A (zh) * | 2017-05-02 | 2017-09-05 | 北京理工大学 | 一种基于光学和多普勒雷达的小天体软着陆自主导航方法 |
CN107883965A (zh) * | 2017-04-24 | 2018-04-06 | 长春工业大学 | 基于光学信息交互多模型强跟踪容积卡尔曼滤波导航方法 |
WO2020087846A1 (zh) * | 2018-10-31 | 2020-05-07 | 东南大学 | 基于迭代扩展卡尔曼滤波融合惯性与单目视觉的导航方法 |
CN111860589A (zh) * | 2020-06-12 | 2020-10-30 | 中山大学 | 一种多传感器多目标协同探测信息融合方法、系统 |
CN113408623A (zh) * | 2021-06-21 | 2021-09-17 | 北京理工大学 | 非合作目标柔性附着多节点融合估计方法 |
CN113432609A (zh) * | 2021-06-16 | 2021-09-24 | 北京理工大学 | 柔性附着状态协同估计方法 |
-
2021
- 2021-12-23 CN CN202111591545.0A patent/CN114296069B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006104552A1 (en) * | 2005-03-29 | 2006-10-05 | Honeywell International Inc. | Method and apparatus for high accuracy relative motion determinatation using inertial sensors |
CN107883965A (zh) * | 2017-04-24 | 2018-04-06 | 长春工业大学 | 基于光学信息交互多模型强跟踪容积卡尔曼滤波导航方法 |
CN107132542A (zh) * | 2017-05-02 | 2017-09-05 | 北京理工大学 | 一种基于光学和多普勒雷达的小天体软着陆自主导航方法 |
WO2020087846A1 (zh) * | 2018-10-31 | 2020-05-07 | 东南大学 | 基于迭代扩展卡尔曼滤波融合惯性与单目视觉的导航方法 |
CN111860589A (zh) * | 2020-06-12 | 2020-10-30 | 中山大学 | 一种多传感器多目标协同探测信息融合方法、系统 |
CN113432609A (zh) * | 2021-06-16 | 2021-09-24 | 北京理工大学 | 柔性附着状态协同估计方法 |
CN113408623A (zh) * | 2021-06-21 | 2021-09-17 | 北京理工大学 | 非合作目标柔性附着多节点融合估计方法 |
Non-Patent Citations (4)
Title |
---|
刘世前;朱纪洪;胡金春;: "柔性飞机阵风载荷减缓飞行控制律设计", 系统仿真学报, no. 11, 5 June 2007 (2007-06-05) * |
艾青林;郑凯;宋国正;: "钢结构建筑探伤机器人刚柔耦合空间位姿解析与实验研究", 机器人, no. 05, 15 March 2018 (2018-03-15) * |
韩涛;朱耀麟;卢健;: "空间再入飞行体多传感观测融合仿真研究", 物联网技术, no. 10, 15 October 2012 (2012-10-15) * |
马广富;王伟;张伟;黄庆龙;彭玉明;张晓;: "面向小推力变轨的天文组合自主导航方法", 宇航学报, no. 09, 30 September 2020 (2020-09-30) * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115246491A (zh) * | 2022-07-22 | 2022-10-28 | 北京理工大学 | 小天体柔性附着协同制导方法 |
CN115246491B (zh) * | 2022-07-22 | 2024-05-28 | 北京理工大学 | 小天体柔性附着协同制导方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114296069B (zh) | 2024-05-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105371870B (zh) | 一种基于星图数据的星敏感器在轨精度测量方法 | |
CN106772524B (zh) | 一种基于秩滤波的农业机器人组合导航信息融合方法 | |
CN109269511B (zh) | 未知环境下行星着陆的曲线匹配视觉导航方法 | |
CN110174123B (zh) | 一种磁传感器实时标定方法 | |
CN114111818B (zh) | 一种通用视觉slam方法 | |
CN107621266A (zh) | 基于特征点跟踪的空间非合作目标相对导航方法 | |
CN110059439A (zh) | 一种基于数据驱动的航天器轨道确定方法 | |
CN110686684B (zh) | 一种小天体环绕探测器光学协同定轨方法 | |
CN107167145B (zh) | 一种自适应非接触式失效卫星的形态参数测算方法 | |
CN111783248A (zh) | 一种工业机器人动力学建模及动力学参数识别方法 | |
CN114296069B (zh) | 一种基于视觉雷达的小天体探测器多模型导航方法 | |
CN109093620A (zh) | 一种双目相机辅助的空间非合作目标动力学参数辨识方法 | |
CN104729510A (zh) | 一种空间目标相对伴飞轨道确定方法 | |
CN103268070B (zh) | 空间多运动体相对运动缩比半物理仿真系统 | |
CN113359444B (zh) | 基于神经网络的挠性航天器刚柔耦合特性智能辨识方法 | |
CN109668562A (zh) | 一种考虑偏差时引入伪测量的重力梯度运动学导航方法 | |
CN113340324B (zh) | 一种基于深度确定性策略梯度的视觉惯性自校准方法 | |
Liu et al. | Navigational drift analysis for visual odometry | |
Luo et al. | End‐Effector Pose Estimation in Complex Environments Using Complementary Enhancement and Adaptive Fusion of Multisensor | |
CN113029173A (zh) | 车辆导航方法及装置 | |
CN116907503A (zh) | 一种基于抗野值鲁棒定位算法的遥感编队卫星定位方法及系统 | |
CN111553954A (zh) | 一种基于直接法单目slam的在线光度标定方法 | |
CN114705223A (zh) | 多移动智能体在目标跟踪中的惯导误差补偿方法及系统 | |
Verveld et al. | Optic flow based state estimation for an indoor micro air vehicle | |
Pesti et al. | Particle swarm optimization aided calibration of sensor installation errors for MEMS accelerometers |
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 |