基于激光测距成像仪的相对位姿确定方法专利检索-坐标系工业自动化和数控机床专利检索查询-专利查询网

基于激光测距成像仪的相对位姿确定方法

阅读：890发布：2023-03-05

专利汇可以提供基于激光测距成像仪的相对位姿确定方法专利检索，专利查询，专利分析的服务。并且一种基于激光测距成像仪的相对位姿确定方法，本发明属于导航定位技术领域。其特征在于包括以下步骤：(1)激光测距成像仪获取到三个特征测量点pi的矢量(距离+方向)(2)构建参考坐标系 orxryrzr；(3)构建相对位置和相对姿态。本方法可以有效克服传统的基于光学CCD相机的位姿确定算法中存在的计算量大、收敛速度慢、导航精度低等缺点。，下面是基于激光测距成像仪的相对位姿确定方法专利的具体信息内容。

权利要求

1.一种基于激光测距成像仪的相对位姿确定方法，其特征在于包括以下步骤：
(1)、激光测距成像仪获取到三个特征测量点pi的矢量其中i＝1，2，3

(2)、构建参考坐标系orxryrzr

(3)、相对位置和姿态的构建
相对位置： $\vec{R_{r}} = - \vec{L_{1}}$
相对姿态矩阵：
定义ψ，θ，φ是体固联坐标系相对与参考坐标系的姿态角，即相对姿态角，假设按照3(ψ)-2(θ)-1(φ)顺序旋转可以得到姿态矩阵：
$A = [\begin{matrix} \cos θ \cos ψ & \cos θ \sin ψ & - \sin θ \\ \sin φ \sin θ \cos ψ - \cos φ \sin ψ & \sin φ \sin θ \sin ψ + \cos φ \cos ψ & \sin φ \cos θ \\ \cos φ \sin θ \cos ψ + \sin φ \sin ψ & \cos φ \sin θ \sin ψ - \sin φ \cos ψ & \cos φ \cos θ \end{matrix}]$
进而可以得到相对姿态角：
$ψ = \arctan (\frac{A (1,2)}{A (1,1)})$
θ＝-arcsin(A(1，3))

说明书全文

技术领域

本发明属于导航定位技术领域。

背景技术

相对位姿确定方法在机器人导航定位、航天器交会对接、编队飞行等众多领域有着极其重要的应用价值。目前，相对位姿确定方法使用较多的传感器主要是光学CCD导航相机。通过多个非共线视线矢量(单位方向矢量)的测量，通过近似假设得到相对位置和姿态的近似解析解(参考文献1：N.K Philip，Ananthasayanam M R.Relative position and attitude estimation and controlschemes for the final phase of an autonomous docking mission of spacecraft.Acta Astronautica，2003，52：511-522；参考文献2：王保丰，李广云，于志坚.飞行器自主交会对接逼近阶段单台CCD测量方法研究.宇航学报，2007，28(1)：22-27)。或者借助于最小二乘算法得到相对位姿的最小方差(或者其他非线性估计方法)意义下的解(参考文件3：JU-YOUNG DU.Vision based NavigationSystem for Autonomous Proximity Operations：An Experimental andAnalytical Study.Ph.D.dissertation，Texas A&M University，December2004)。上述相对位置和姿态的近似解析解求取的过程中由于近似假设的存在，位姿导航误差也会一直存在解析解中；而基于非线性估计的相对位姿确定方法存在着计算量大、导航收敛困难和精度低的缺点。同时，由于计算机视觉中的模式识别图像处理需要很大的计算资源，所有使用CCD相机作为导航传感器的基于视觉的导航算法都存在数据计算量大、数据更新率低的缺点，这些缺点有时候将会导致暂时的跟踪识别目标丢失、从而最终导致导航失败。

发明内容

为了克服传统的基于光学CCD相机的位姿确定算法中存在的计算量大、收敛速度慢、导航精度低等缺点，本发明给出了一种采用基于高采样速率的激光测距成像仪的相对位姿确定方法。
具体的位姿流程如下：
1)激光测距成像仪获取到三个特征测量点pi(i＝1，2，3)的矢量(距离+方向)

\vec{L_{i}} (i = 1,2,3);

2)构建参考坐标系orxryrzr；

3)相对位置和姿态的构建
相对位置：

\vec{R_{r}} = - \vec{L_{1}}

相对姿态矩阵(坐标变换矩阵)：
定义ψ，θ，φ是体固联坐标系相对与参考坐标系的姿态角，即相对姿态角，假设按照3(ψ)-2(θ)-1(φ)顺序旋转可以得到姿态矩阵：

A = [\begin{matrix} \cos θ \cos ψ & \cos θ \sin ψ & - \sin θ \\ \sin φ \sin θ \cos ψ - \cos φ \sin ψ & \sin φ \sin θ \sin ψ + \cos φ \cos ψ & \sin φ \cos θ \\ \cos φ \sin θ \cos ψ + \sin φ \sin ψ & \cos φ \sin θ \sin ψ - \sin φ \cos ψ & \cos φ \cos θ \end{matrix}]

进而可以得到相对姿态角：

ψ = \arctan (\frac{A (1,2)}{A (1,1)})

θ＝-arcsin(A(1，3))

φ = \arctan (\frac{A (2,3)}{A (3,3)})

和传统的基于光学CCD导航相机的相对位姿确定算法相比，基于激光测距成像仪的相对位姿确定算法有以下优点：
(1)该方法计算量小，计算速度快；这一优点可以保证比较好的导航实时性。
(2)由于激光测距成像仪可以直接提供距离测量信息，使位姿确定算法的可靠性较光学CCD/视觉导航有了很大的提高。
该方法是从经典的双矢量定姿原理得到启发，通过三矢量观测来直接确定相对位置和姿态等参数，是对双矢量定姿的发展和推广。本方法可以有效地解决单独使用光学CCD相机进行位姿确定过程中存在的问题。在航天器交会对接、编队飞行和机器人导航定位等众多领域都有着极其重要的应用价值。
附图说明
图1为相对位姿确定示意图。位姿确定的物理含义：通过对激光测距成像仪的测量输出进行相应的处理和运算，得到体固联坐标系相对于构建参考坐标系的位置矢量和位姿矢量[ψ，θ，φ]T。
附图中相关标注说明：
orxryrzr—构建所得到的参考坐标系；
obxbybzb—体固联参考坐标系(与导航仪器固联)；
pi(i＝1，2，3)—特征测量点(测量对应点)；
—激光测距成像输出的三个测量矢量；

具体实施方式

具体实施方式一：合作目标间的相对位姿确定。航天器的交会对接、编队飞行等都属于这一类别。此时，测量对应点在参考系下的位置矢量已知，通过一个简单的坐标变换就可以得到两个航天器之间的相对位置和姿态。
具体实施方式二：非合作目标间的相对位姿确定。机器人的导航定位、着陆小行星等属于该类别。方式二区别于方式一的地方在于测量对应点在参考系下的位置矢量是未知的，所得到的相对位置和姿态是相对于构建参考坐标系的。

标题	发布/更新时间	阅读量
获取工件坐标系方法	2020-05-11	427
影像坐标系与机械坐标系的转换方法及系统	2020-05-12	792
平面直角坐标系展示仪	2020-05-11	159
机器人坐标系转换方法	2020-05-11	450
一种测量星敏感器测量坐标系与棱镜坐标系关系的方法	2020-05-12	330
稀疏SLAM坐标系的共享	2020-05-11	673
一种导航模块坐标系与机器人坐标系的转换方法	2020-05-13	917
坐标系关联方法及系统	2020-05-11	149
工件坐标系修正方法	2020-05-11	631
扫描仪坐标系与工程测量坐标系的变换方法	2020-05-12	4

基于激光测距成像仪的相对位姿确定方法

技术领域

背景技术

发明内容

具体实施方式

该功能需要专业版企业版VIP权限，您可以：