一种基于混合卡尔曼滤波的自由漂浮目标位姿预测方法技术

本发明专利技术涉及一种基于混合卡尔曼滤波的自由漂浮目标位姿预测方法，包括以下步骤：步骤一、建立自由漂浮目标动力学模型；步骤二、设计混合卡尔曼滤波器，利用混合卡尔曼滤波对运动状态及动力学模型参数进行估计；步骤三、利用所估计的运动参数对漂浮目标未来一段时间轨迹进行预测。目标的姿态参数用轴角来表示，记为，位置分别为三个轴独立的运动，利用所估计运动信息对未来一段时间内的位置和姿态进行预测，得到未来某一时刻的位姿。本发明专利技术滚动实时对自由漂浮目标轨迹进行长周期预测，准确性好，从而为后续机械臂的抓捕奠定基础。

A method of free floating target pose prediction based on hybrid Kalman filter

【技术实现步骤摘要】
一种基于混合卡尔曼滤波的自由漂浮目标位姿预测方法
本专利技术属于自由漂浮目标位姿预测领域，具体涉及一种基于混合卡尔曼滤波的自由漂浮目标位姿预测方法。
技术介绍
在未来的空间活动中空间机器人将扮演越来越重要的角色，其在清理空间碎片、在轨维修、空间建设和稳定卫星轨道和其他大型空间结构问题上具有广阔的应用前景。空间机器人的重要任务包括抓捕轨道上的卫星或其他类似物体，以便回收并修复失效的卫星，营救失去控制的载人航天器，或者移除较大的空间碎片。其中大部分无法测量自身的运动与姿态信息，变成了非合作目标，可能会以较大的角速度做翻滚运动。目前的方法大多是利用相机测量非合作目标的位姿，对合作目标动力学动力学参数模型进行辨识，利用辨识的动力学模型进行位姿的预测。文献[1]基于欧拉情形解析解提取了描述自由漂浮刚体(目标)姿态运动的一组动力学参数和描述姿态运动的动量矩坐标系的参数，将这些参数作为预测目标刚体姿态运动的参数，然后利用目标刚体姿态运动的观测结果按一系列步骤依次求出各个参数，达到预测姿态运动的目的。文献[2]利用优化的方法求解最佳的动力学参数(刚体的本文档来自技高网...

【技术保护点】
1.一种基于混合卡尔曼滤波的自由漂浮目标位姿预测方法，其特征在于，包括以下步骤：/n步骤1、建立自由漂浮目标动力学模型；/n步骤2、设计混合卡尔曼滤波器，利用混合卡尔曼滤波对运动状态及动力学模型参数进行估计；/n步骤3、利用所估计的运动参数对漂浮目标未来一段时间轨迹进行预测，其中，定义位置为三个方向独立的运动，用p＝[x,y,z]表示，目标的姿态参数用轴角来表示，记为φ＝(e,θ)，对未来一段时间内的位置和姿态进行预测，得到未来某一时刻的位姿。/n

【技术特征摘要】
1.一种基于混合卡尔曼滤波的自由漂浮目标位姿预测方法，其特征在于，包括以下步骤：
步骤1、建立自由漂浮目标动力学模型；
步骤2、设计混合卡尔曼滤波器，利用混合卡尔曼滤波对运动状态及动力学模型参数进行估计；
步骤3、利用所估计的运动参数对漂浮目标未来一段时间轨迹进行预测，其中，定义位置为三个方向独立的运动，用p＝[x,y,z]表示，目标的姿态参数用轴角来表示，记为φ＝(e,θ)，对未来一段时间内的位置和姿态进行预测，得到未来某一时刻的位姿。


2.根据权利要求1所述的一种基于混合卡尔曼滤波的自由漂浮目标位姿预测方法，其特征在于，所述动力学模型按照以下步骤建立：
航天器相对于本体系得惯量矩阵为：



刚体的角动量为：



根据动量矩定理，外力矩可表示为：



目标姿态动力学的一般方程为：



由于自由漂浮目标绕惯量主轴旋转，Ixy＝Ixz＝Iyz＝0，τ＝[0,0,0]T动力学模型简化为：








3.根据权利要求2所述的一种基于混合卡尔曼滤波的自由漂浮目标位姿预测方法，其特征在于，基于混合卡尔曼滤波估计所述步骤1中所建模型的参数，估计方法按照以下步骤建立：
步骤1.1、选取状态观测量为
X＝[qTωTIT]T
其中q为姿态四元数，ω为角速度，I为惯性参数
步骤1.2、令
其中Ω(ω)为欧拉角与四元数的转换矩阵，且
步骤1.3、系统状态方程表示为：



此...

【专利技术属性】
技术研发人员：肖晓晖，张勇，汤自林，赵尚宇，
申请(专利权)人：武汉大学，
类型：发明
国别省市：湖北;42