CN108225335B - 一种用于多目偏振视觉的航向角求解方法 - Google Patents
一种用于多目偏振视觉的航向角求解方法 Download PDFInfo
- Publication number
- CN108225335B CN108225335B CN201810063658.5A CN201810063658A CN108225335B CN 108225335 B CN108225335 B CN 108225335B CN 201810063658 A CN201810063658 A CN 201810063658A CN 108225335 B CN108225335 B CN 108225335B
- Authority
- CN
- China
- Prior art keywords
- polarization
- sky
- solving
- information
- polarized
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Image Analysis (AREA)
Abstract
本发明属于偏振光导航领域,具体公开了一种用于多目偏振视觉的航向角求解方法。首先利用多目偏振视觉传感器测量大气偏振信息,主要是偏振角和偏振度信息;其次求解天空偏振度的梯度信息,识别剔除图像中的遮挡障碍区域,根据标准Rayleigh散射,利用天空区域的偏振信息建立偏振光的定向模型;最后建立航向角的目标优化函数,采用全局最小二乘的方法获取航向角的最优解,从而实现多目偏振视觉的定向。本发明充分利用了天空偏振光的梯度信息和多测量点的偏振角信息,能够有效地剔除遮挡障碍物和减小测量噪声对多目偏振视觉定向的影响,能够提高偏振光的定向精度,具有原理简单、鲁邦性强、定向精度高的优点,为实现多目偏振视觉导航提供了定向基础。
Description
技术领域
本发明涉及一种用于多目偏振视觉的航向角求解方法,属于偏振光导航领域。
背景技术
为了提高无人平台的自主导航能力,除了采用传统的卫星导航系统、惯性导航系统之外,还需要积极探索新的导航方法和手段,基于大自然生物系统的模拟仿生感知技术,为导航技术的新发展提供了启示。准确的航向信息是实现自主导航的关键。自然界中很多昆虫和鸟类通过特殊的生理结构感知天空的偏振光信息,从而进行导航活动。例如,沙漠蚂蚁通过检测大气中的偏振模态确定方位信息,可以从距离巢穴数百米的地方沿直线准确返回,蜜蜂、蝴蝶等昆虫也可通过感知天空偏振光的强度和方向实现导航定位。与经典导航技术相比,仿生偏振光导航利用具有自然属性的天空偏振模式,具有抗干扰性强、误差不积累、适用范围广等优势,比较适合复杂环境下的长航时、远距离的自主导航,对于车辆、船舶、飞行器等领域的应用具有广泛前景。
基于多目视觉而设计的偏振光传感器,从结构上接近于昆虫的复眼结构,具有若干像素级的偏振测量单元,可以实现全天域的偏振信息的精细化测量。与传统的基于光电二极管式的点型偏振光传感器相比,具有检测区域广、测量不易受天气变化等因素影响的优势,并且在基于多目视觉的偏振光传感器中,相机的CCD测量噪声较小,有利于实现全天域精细化的偏振信息测量。从目前公开发表的文献看,鲜有文献对基于区域偏振信息的偏振光定向方法进行深入研究,尤其是地面无人平台在城市环境中进行偏振光定向时,偏振图像会受到外界障碍物的遮挡,严重影响偏振信息的准确性,若直接进行计算,势必会对定向结果的精度产生较大影响,此外利用单测量点的偏振信息进行定向的方法,易受到环境干扰和测量噪声的影响,方法鲁邦性不强,解算结果精度不高,因此需要寻求一种利用偏振信息在线去除遮挡障碍,并且能够有效利用多点偏振信息实现鲁邦性强、精度高的航向角求解方法。
发明内容
本发明要解决的技术问题就在于:在有遮挡障碍环境中如何有效地利用多目偏振视觉测量信息获取载体的航向信息。
为解决上述技术问题,本发明提出的解决方案为:
一种用于多目偏振视觉的航向角求解方法,其特征在于包括以下几个步骤:
(1)求解天空偏振度的梯度信息,识别剔除偏振图像中的遮挡障碍区域,建立偏振光定向模型;
(2)建立求解航向角的目标优化函数,并利用全局最小二乘法求解航向角。
所述步骤(1)通过以下步骤实现:
1)求解偏振度的梯度信息
由多目偏振视觉传感器获取的偏振信息,包含偏振角β(i,j)和偏振度χ(i,j),偏振度的梯度求解方法为:
式中,grad(·)表示梯度值,(i,j)表示像素位置;
2)识别偏振图像中的天空与非天空区域,按照一定规则剔除偏振图像中的遮挡障碍区域根据每个像素的梯度信息,剔除规则如下:
式中,Sky表示天空区域,non-Sky表示非天空区域,ε为梯度阈值,一般取0.02~0.07。
3)利用天空区域的偏振信息,建立偏振光定向模型
偏振光的定向模型为:
[vl×]-1vp=λKxs (3)
式中,xs=[sin(ψ+δs) cos(ψ+δs) 1]T,ψ为航向角,δs为太阳方位角,vp为偏振光的E 矢量方向的单位矢量,vl为观测散射光方向的单位矢量,K为由太阳矢量的变换矩阵,λ为常数。
所述步骤(2)通过以下步骤实现:
1)利用天空区域多测量点的偏振角信息建立的定向方程为:
式中,J和D为相关测量矩阵与向量,R和r为测量噪声;
2)建立求解航向角的目标优化函数
令F=[-D J],y=[1 cos(ψ+δs) sin(ψ+δs)]T,则求解航向角的目标优化函数为:
min||Fy||2=minyTFTFy (5)
s.t.yTy=2 (6)
3)利用全局最小二乘法求解航向角
根据全局最小二乘可知,上述目标函数的最优解y*为矩阵FTF的最小特征值对应的特征向量,则载体的航向角为:
ψ=arctan(y*(3)/y*(2))-δs (7)
式中,y*(·)表示组成向量y*的单个元素。
与现有技术相比,本发明的优点在于:
(1)本发明根据偏振测量的梯度信息,能够实现在线剔除偏振图像中的遮挡障碍,为提高偏振光定向精度提供了基础;
(2)本发明利用多个有效的偏振测量信息,并考虑测量噪声的影响,采用全局最小二乘的优化方法实现航向角的估计,具有计算简单、操作简便、精度高的优势。
附图说明
图1为本发明方法的流程示意图;
图2为本发明方法的具体计算流程图;
图3为本发明方法利用偏振信息去除遮挡障碍的结果图。
具体实施方式
以下将结合说明书附图和具体实施例对本发明作进一步详细说明。
如图1和图2所示,本发明涉及的一种用于多目偏振视觉的航向角求解方法,其原理为:该方法首先利用多目偏振视觉传感器测量天空偏振光的偏振信息,然后求解天空偏振度的梯度信息,识别剔除偏振图像中的遮挡障碍区域,根据大气标准Rayleigh散射,利用天空区域的偏振信息建立偏振光定向模型,最后建立航向角的目标优化函数,采用全局最小二乘的方法求解目标函数的最优解,从而实现多目偏振视觉的定向。
结合具体应用实例,本发明的具体流程为:
1.利用多目偏振视觉传感器测量天空偏振光的偏振信息。
2.求解偏振梯度信息,识别剔除偏振图像中的遮挡障碍区域,建立偏振光定向模型。
1)每个相机中各像素点的偏振角信息为β(i,j),偏振度信息为χ(i,j),求解各像素点的偏振度的梯度信息:
式中,grad(·)表示梯度值,(i,j)表示像素位置。
2)识别偏振图像中的天空与非天空区域,按照一定规则剔除偏振图像中的遮挡障碍区域。非遮挡障碍的区域为天空区域,记为Sky,遮挡障碍的区域为非天空区域,记为non-Sky,识别剔除规则为:
式中,ε为梯度阈值,本发明取为0.05。偏振梯度去遮挡障碍结果如图3所示,第一行为含有遮挡障碍的原始图像,第二行为偏振梯度图像,第三行为剔除遮挡障碍后的偏振图像,第四行为未剔除遮挡障碍的偏振图像。在第四行的偏振图像中,由于遮挡障碍区域的偏振信息含有大量随机误差,直接运算会对定向精度产生较大影响,与此相比,本算法能够有效地去除遮挡障碍区域(前三行为本算法流程的结果说明),仅利用天空区域的偏振信息进行解算,保证了定向结果的精度。
3)根据大气标准Raleigh散射模型可知,偏振光的E矢量方向始终垂直于太阳、观测点和散射点所组成的平面,则偏振光的定向模型为:
[vl×]-1vp=λKxs (3)
式中,xs=[sin(ψ+δs) cos(ψ+δs) 1]T,ψ为航向角,δs为太阳方位角,vp为偏振光的E 矢量方向的单位矢量,vl为观测散射光方向的单位矢量,[vl×]为相应的反对称矩阵,K为由载体太阳矢量的转换矩阵,λ为常数。
偏振光的E矢量方向的单位矢量vp为:
式中,β为测量点的偏振角信息,αc、αh为像素的姿态变换角,可由像素的位置和相机的标定参数获得:
式中,(u0,v0)为图像的中心坐标,f为相机焦距。可由相机标定获得。
观测散射光方向的单位矢量vl为:
vl=[sinαccosαh sinαhsinαc cosαh]T (6)
太阳方向矢量的转换矩阵K为:
式中,p和q分别为载体的俯仰角和滚动角,可由惯性传感器获得,δh为太阳高度角,可由天文日历查询得到。
3.利用天空区域的多个测量点,建立求解航向角的目标优化函数,利用全局最小二乘法求解航向角。
1)利用天空区域多测量点的偏振信息建立的定向方程。根据上述定向模型可得:
T(1)sin(αc)sin(αh)-T(2)cos(αc)sin(αh)-T(3)tanβ=0 (8)
式中,T(·)为组成矩阵T的行向量。
记[vl×]K=A,c=[sinαcsinαh -cosαcsinαh -tanβ]T,a1、a2和a3分别为矩阵A的列向量,则上式可写为:
即:
假设多目偏振视觉可获取n(n≥2)有效测量点,则式(17)可写为:
式中,si(i=1,2,…,n)为第i个测量点的相关矩阵,di(i=1,2,…,n)为第i个测量点的响应值。
写成矩阵形式为:
2)建立求解航向角的目标优化函数。由于在实际测量中,多目偏振视觉传感器的测量误差以及外界天气条件的影响,偏振光定向收到测量噪声的影响。考虑测量噪声,则上式可重写为:
式中,R和r为测量噪声。
令F=[-D J],y=[1 cos(ψ+δs) sin(ψ+δs)]T,根据全局最小理论可知,求解航向角的目标优化函数为:
min||Fy||2=minyTFTFy (14)
s.t.yTy=2 (15)
3)利用全局最小二乘法求解航向角。根据全局最小二乘可知,上述目标函数的最优解y*为矩阵FTF的最小特征值对应的特征向量,则载体的航向角为:
ψ=arctan(y*(3)/y*(2))-δs (16)
式中,y*(·)表示组成向量y*的单个元素。
以上所述仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (1)
1.一种用于多目偏振视觉的航向角求解方法,其特征在于包括以下几个步骤:
(1)求解天空偏振度的梯度信息,识别剔除偏振图像中的遮挡障碍区域,建立偏振光定向模型;
步骤(1)通过以下步骤实现:
1)求解偏振度的梯度信息
由多目偏振视觉传感器获取的偏振信息,包含偏振角β(i,j)和偏振度χ(i,j),偏振度的梯度求解方法为:
式中,grad(·)表示梯度值,(i,j)表示像素位置;
2)识别偏振图像中的天空与非天空区域,按照如下规则剔除偏振图像中的遮挡障碍区域根据每个像素的梯度信息,剔除规则如下:
式中,Sky表示天空区域,non-Sky表示非天空区域,ε为梯度阈值,取值范围0.02~0.07;
3)利用天空区域的偏振信息,建立偏振光定向模型
偏振光的定向模型为:
[vl×]-1vp=λKxs (3)
式中,xs=[sin(ψ+δs) cos(ψ+δs) 1]T,ψ为航向角,δs为太阳方位角,vp为偏振光的E矢量方向的单位矢量,vl为观测散射光方向的单位矢量,K为太阳矢量的变换矩阵,λ为常数;
(2)建立求解航向角的目标优化函数,并利用全局最小二乘法求解航向角;
步骤(2)通过以下步骤实现:
1)利用天空区域多测量点的偏振角信息建立的定向方程为:
式中,J和D为相关测量矩阵与向量,R和r为测量噪声;
2)建立求解航向角的目标优化函数
令F=[-D J],y=[1 cos(ψ+δs) sin(ψ+δs)]T,则求解航向角的目标优化函数为:
min||Fy||2=minyTFTFy (5)
s.t.yTy=2 (6)
3)利用全局最小二乘法求解航向角
根据全局最小二乘可知,上述目标函数的最优解y*为矩阵FTF的最小特征值对应的特征向量,则载体的航向角为:
ψ=arctan(y*(3)/y*(2))-δs (7)
式中,y*(·)表示组成向量y*的单个元素。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810063658.5A CN108225335B (zh) | 2018-01-23 | 2018-01-23 | 一种用于多目偏振视觉的航向角求解方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810063658.5A CN108225335B (zh) | 2018-01-23 | 2018-01-23 | 一种用于多目偏振视觉的航向角求解方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108225335A CN108225335A (zh) | 2018-06-29 |
CN108225335B true CN108225335B (zh) | 2020-06-19 |
Family
ID=62668481
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810063658.5A Active CN108225335B (zh) | 2018-01-23 | 2018-01-23 | 一种用于多目偏振视觉的航向角求解方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108225335B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109506660B (zh) * | 2019-01-08 | 2022-03-29 | 大连理工大学 | 一种用于仿生导航的姿态最优化解算方法 |
CN113532419A (zh) * | 2021-06-23 | 2021-10-22 | 合肥工业大学 | 天空偏振模式信息获取方法、装置、电子设备和存储介质 |
CN113280785B (zh) * | 2021-07-22 | 2021-09-28 | 中国人民解放军国防科技大学 | 基于偏振模式一致性的天空偏振光定向方法 |
CN115062770B (zh) * | 2022-08-04 | 2022-11-08 | 中国人民解放军国防科技大学 | 基于广义仿生偏振光导航模型及求解的导航方法 |
CN115014311B (zh) * | 2022-08-08 | 2022-11-01 | 中国人民解放军国防科技大学 | 一种基于大气偏振信息剔除天空遮挡的光罗盘定向方法 |
CN115574816B (zh) * | 2022-11-24 | 2023-03-14 | 东南大学 | 仿生视觉多源信息智能感知无人平台 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102177719A (zh) * | 2009-01-06 | 2011-09-07 | 松下电器产业株式会社 | 摄像装置朝向检测装置和具备该装置的移动体 |
CN102967311A (zh) * | 2012-11-30 | 2013-03-13 | 中国科学院合肥物质科学研究院 | 基于天空偏振分布模型匹配的导航定位方法 |
US9057896B1 (en) * | 2012-12-20 | 2015-06-16 | Amazon Technologies, Inc. | Orientation variable polarization |
CN105547236A (zh) * | 2015-12-08 | 2016-05-04 | 大连理工大学 | 一种仿生方向分析器 |
CN105698819A (zh) * | 2016-01-18 | 2016-06-22 | 中国人民解放军国防科学技术大学 | 一种用于多相机偏振光传感器的标定方法 |
CN106643704A (zh) * | 2017-01-16 | 2017-05-10 | 中国人民解放军国防科学技术大学 | 基于大气偏振模式的太阳方位获取方法 |
CN107131956A (zh) * | 2017-04-18 | 2017-09-05 | 大连理工大学 | 一种全自动图像式天空偏振光测试系统 |
CN107728106A (zh) * | 2017-09-30 | 2018-02-23 | 中国人民解放军国防科技大学 | 一种微阵列式偏振光罗盘的定向方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3060880A4 (en) * | 2013-10-22 | 2017-07-05 | Polaris Sensor Technologies, Inc. | Sky polarization and sun sensor system and method |
-
2018
- 2018-01-23 CN CN201810063658.5A patent/CN108225335B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102177719A (zh) * | 2009-01-06 | 2011-09-07 | 松下电器产业株式会社 | 摄像装置朝向检测装置和具备该装置的移动体 |
CN102967311A (zh) * | 2012-11-30 | 2013-03-13 | 中国科学院合肥物质科学研究院 | 基于天空偏振分布模型匹配的导航定位方法 |
US9057896B1 (en) * | 2012-12-20 | 2015-06-16 | Amazon Technologies, Inc. | Orientation variable polarization |
CN105547236A (zh) * | 2015-12-08 | 2016-05-04 | 大连理工大学 | 一种仿生方向分析器 |
CN105698819A (zh) * | 2016-01-18 | 2016-06-22 | 中国人民解放军国防科学技术大学 | 一种用于多相机偏振光传感器的标定方法 |
CN106643704A (zh) * | 2017-01-16 | 2017-05-10 | 中国人民解放军国防科学技术大学 | 基于大气偏振模式的太阳方位获取方法 |
CN107131956A (zh) * | 2017-04-18 | 2017-09-05 | 大连理工大学 | 一种全自动图像式天空偏振光测试系统 |
CN107728106A (zh) * | 2017-09-30 | 2018-02-23 | 中国人民解放军国防科技大学 | 一种微阵列式偏振光罗盘的定向方法 |
Non-Patent Citations (4)
Title |
---|
Haze,clouds and limited sky visibility: polarotactic orientation of crickets under difficult stimulus conditions;Miriam J.Henze 等;《The Journal of Experimental Biology 210》;20071231;第3266-3276页 * |
Polarized Light Compass-Aided Visual-Inertial Navigation Under Foliage Environment;Yujie Wang 等;《IEEE SENSORS JOURNAL》;20170901;第17卷(第17期);第5646-5653页 * |
仿生偏振视觉定位定向机理与实验;王玉杰 等;《光学 精密工程》;20160930;第24卷(第9期);第2109-2116页 * |
基于大气偏振光学的太阳跟踪方法;王晨光 等;《科学技术与工程》;20161031;第16卷(第29期);第20-26页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108225335A (zh) | 2018-06-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108225335B (zh) | 一种用于多目偏振视觉的航向角求解方法 | |
US10408918B2 (en) | Sky polarization and sun sensor system and method | |
Dupeyroux et al. | An ant-inspired celestial compass applied to autonomous outdoor robot navigation | |
English et al. | Vision based guidance for robot navigation in agriculture | |
CN107728106B (zh) | 一种微阵列式偏振光罗盘的定向方法 | |
Stürzl et al. | A fisheye camera system for polarisation detection on UAVs | |
CN110231025B (zh) | 一种基于捷联式偏振光罗盘的动态定向方法及系统 | |
CN114910080B (zh) | 基于水下下行辐射光强和偏振光场的三维航姿确定方法 | |
CN112444245B (zh) | 一种基于偏振光、光流矢量、双目视觉传感器的仿昆虫视觉组合导航方法 | |
Dupeyroux et al. | A bio-inspired celestial compass applied to an ant-inspired robot for autonomous navigation | |
Khoshelham et al. | Vehicle positioning in the absence of GNSS signals: Potential of visual-inertial odometry | |
Fang et al. | Review on bio-inspired polarized skylight navigation | |
Fan et al. | Bio-inspired multisensor navigation system based on the skylight compass and visual place recognition for unmanned aerial vehicles | |
Mumtaz et al. | Attitude determination by exploiting geometric distortions in stereo images of DMC camera | |
Pan et al. | An optical flow-based integrated navigation system inspired by insect vision | |
Hoffmeister et al. | 3D terres-trial laser scanning for field crop modelling | |
WO2024109002A1 (zh) | 仿生视觉多源信息智能感知无人平台 | |
Usher et al. | A camera as a polarized light compass: Preliminary experiments | |
CN110887477A (zh) | 一种基于偏振北极点及偏振太阳矢量的自主定位方法 | |
Grishin | Estimation of Visual Shoreline Navigation Errors | |
CN110887475B (zh) | 一种基于偏振北极点及偏振太阳矢量的静基座粗对准方法 | |
Liu et al. | A Review of Bionic Polarized Light Localization Methods | |
Courtier et al. | Ground vehicle navigation based on the skylight polarization | |
Moutenet et al. | Ultraviolet vs. visible skylight polarization measurements | |
Zhang et al. | Star image simulation and subpixel centroiding for an earth observing sensor |
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 |