CN106575120B - 用于微型无人机的飞行地形识别的方法和装置 - Google Patents
用于微型无人机的飞行地形识别的方法和装置 Download PDFInfo
- Publication number
- CN106575120B CN106575120B CN201480057390.4A CN201480057390A CN106575120B CN 106575120 B CN106575120 B CN 106575120B CN 201480057390 A CN201480057390 A CN 201480057390A CN 106575120 B CN106575120 B CN 106575120B
- Authority
- CN
- China
- Prior art keywords
- sensor
- identification device
- sight
- detecting head
- search coverage
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 239000000523 sample Substances 0.000 claims abstract description 41
- 238000005259 measurement Methods 0.000 claims description 24
- 239000011159 matrix material Substances 0.000 claims description 4
- 238000000611 regression analysis Methods 0.000 claims description 4
- 230000006641 stabilisation Effects 0.000 claims description 3
- 238000011105 stabilization Methods 0.000 claims description 3
- 230000003028 elevating effect Effects 0.000 claims 2
- 230000004907 flux Effects 0.000 claims 2
- 238000001514 detection method Methods 0.000 abstract description 55
- 230000003287 optical effect Effects 0.000 description 72
- 230000001174 ascending effect Effects 0.000 description 5
- 150000001875 compounds Chemical class 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 241000251468 Actinopterygii Species 0.000 description 1
- OKTJSMMVPCPJKN-UHFFFAOYSA-N Carbon Chemical compound [C] OKTJSMMVPCPJKN-UHFFFAOYSA-N 0.000 description 1
- 240000006829 Ficus sundaica Species 0.000 description 1
- 229910052799 carbon Inorganic materials 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 230000003014 reinforcing effect Effects 0.000 description 1
- 238000012552 review Methods 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000036962 time dependent Effects 0.000 description 1
- 238000012876 topography Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/04—Control of altitude or depth
- G05D1/06—Rate of change of altitude or depth
- G05D1/0607—Rate of change of altitude or depth specially adapted for aircraft
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U10/00—Type of UAV
- B64U10/80—UAVs characterised by their small size, e.g. micro air vehicles [MAV]
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U50/00—Propulsion; Power supply
- B64U50/10—Propulsion
- B64U50/19—Propulsion using electrically powered motors
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C23/00—Combined instruments indicating more than one navigational value, e.g. for aircraft; Combined measuring devices for measuring two or more variables of movement, e.g. distance, speed or acceleration
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01F—MEASURING VOLUME, VOLUME FLOW, MASS FLOW OR LIQUID LEVEL; METERING BY VOLUME
- G01F1/00—Measuring the volume flow or mass flow of fluid or fluent solid material wherein the fluid passes through a meter in a continuous flow
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0094—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots involving pointing a payload, e.g. camera, weapon, sensor, towards a fixed or moving target
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G5/00—Traffic control systems for aircraft
- G08G5/70—Arrangements for monitoring traffic-related situations or conditions
- G08G5/74—Arrangements for monitoring traffic-related situations or conditions for monitoring terrain
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U2101/00—UAVs specially adapted for particular uses or applications
- B64U2101/55—UAVs specially adapted for particular uses or applications for life-saving or rescue operations; for medical use
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U2201/00—UAVs characterised by their flight controls
- B64U2201/10—UAVs characterised by their flight controls autonomous, i.e. by navigating independently from ground or air stations, e.g. by using inertial navigation systems [INS]
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Mechanical Engineering (AREA)
- Fluid Mechanics (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种表面识别装置,其通过飞行器用于表面的自主运动,所述装置包括:探测头,探测头包括用于性质的至少一个传感器,所述特性取决于探测头的中心到表面的距离,每个传感器覆盖以视线(ZC)为中心的探测区域(ZV);用于每个传感器的探测区域(ZV)的定向的系统(24);以及控制器,控制器处理来自每个传感器的信号并基于所述信号对系统(24)进行控制。控制器估算垂线到表面的方向,并使用所述系统(24)来将每个传感器的视线(ZC)沿与所述垂线的方向间隔重新定向角的方向进行旋转。
Description
技术领域
本发明涉及一种表面识别装置,其用于识别距表面的一定距离处的移动飞行器的自主运动,所述表面识别装置包括:
a)表面探测头,其限定出固定至探测头的坐标系,该坐标系具有位于探测头的中心处的原点,该坐标系还具有前进轴、偏航轴、上升轴,探测头包括用于参量的至少一个传感器,该参量取决于探测头的中心距表面的距离,每个传感器覆盖以视线为中心的探测区域;
b)定向系统,其用于通过使探测区域绕偏航轴旋转来对每个传感器的探测区域进行定向;以及
c)控制器,其适于接收和处理来自每个传感器的信号并基于所述信号来控制用于对探测区域进行定向的系统。
背景技术
这种装置在由专家Fabien和Franck Ruffier于2012年10月16日在“IEEE的关于智能机器人与系统(IROS)的国际会议,维拉摩拉:葡萄牙”中发表的文章“借助光流来控制圆形高顶隧道中的对接、高度和速度(Controlling docking,altitude and speed in acircular high-roofed tunnel thanks to the optic flow)”中已描述。该文章随后将被称为“IROS文章”。
IROS文章中描述了一种微型无人机,即具有两个旋翼的直升机,该微型无人机包括主体,设置有“复合眼”的地形探测头被附接至主体。复合眼由分布在探测头上的四个光流传感器组成。探测头能够由于步进电机而相对于主体转向。当微型无人机在飞行时,探测头相对于主体的角度被控制以使得探测头的定向在地面参考系中保持相同,并对主体在地面参考系中的角度进行补偿。
事实证明,该已知的微型无人机的自主导航系统并不总是能够在杂乱的环境中和/或存在有移动障碍物的情况下避开所有的障碍物。
文献WO 2004/027434 A1的图1示出了一种直升机稳定系统1,其包括具有光学传感器3和旋转传感器9和10的机舱5。机舱5相对于直升机1是固定的。该已知的系统是复杂的并且对震动极其敏感。
发明内容
本发明的一个目的在于为无人机、微型无人机或纳米无人机提供改善的自动驾驶仪以使得无人机、微型无人机或纳米无人机能够在陡峭和/或移动的环境中更好地航行。
本方面的另一目的在于为不具有惯性单元的微型无人机和纳米无人机提供自动驾驶仪。实际上,惯性单元由于其尺寸、重量以及计算能力的需求而仅能够被颇有困难地放置在微型无人机或纳米无人机上。
根据本发明,这些目的通过上文中限定的装置来实现,其特征在于,控制器被配置成:基于所述信号在所述坐标系中估算垂线到表面的方向;以及通过使用所述定向系统来将每个传感器的观察区域的视线旋转至与所述垂线的方向间隔确定的重新定向角的方向中。
通过相对于垂线到表面的方向以已确定的重新定向角对传感器的探测区域的视线进行重新定向,根据本发明的表面识别装置使得能够根据距周围的物体的更精确的距离来测量性质。因此,飞行器能够不出问题地移动,同时例如在存在倾斜的障碍物的情况下通过将视线朝向运动方向定向来避开它可提前探测到的任何障碍物。
根据优选的实施例,在任何技术上可能的组合的情况下,根据本发明的装置包括以下特征中的一个、数个或所有特征:
-重新定向角介于0和90°之间;
-每个传感器是光流传感器,并且控制器被配置成:基于由每个光流传感器传递的信号通过确定最大光流方向来估算垂线到表面的方向;
-控制器被配置成通过执行以下步骤来确定最大的流方向:
a)通过由每个光流传感器提供的光流信号的回归分析,尤其是通过最小二乘法,从探测区域的视线在所述坐标系中的定向确定光流的函数;以及
b)优选地,通过所述函数的微分确定探测区域的视线的定向,所述函数为此具有最大值;
-控制器进一步被配置成:基于所述信号计算置信度指数,并基于置信度指数的值对垂线到表面的方向的估算进行验证或拒绝;
-探测头包括四个光流传感器,即,前腹侧传感器、后腹侧传感器、前背侧传感器以及后背侧传感器;
-探测区域定向系统包括尤其是步进电机的致动器,该致动器能够使表面探测头绕偏航轴旋转;
-光流测量组件包括光电探测器的矩阵,光电探测器绕偏航轴大体覆盖360°x 60°的探测场,探测区域的定向系统能够选择所述光电探测器中的一个或多个子集以表示所述传感器中的每个;
-探测头还配备有探测头的至少一个陀螺仪稳定传感器以在飞行期间补偿所述移动飞行器的旋转运动。
本发明还涉及一种具有自主运动的航空的微型无人机,该微型无人机包括上述的装置,控制器被配置成控制致动器以便将探测头的上升轴沿垂线到表面的估算方向对准,从而将探测头的前进轴保持为与微型无人机飞越过的表面的局部斜线平行。
优选地,该微型无人机进一步包括陀螺测试仪和/或用于控制微型无人机的前进线速度的空速指示器。
根据本发明,上述的目的还通过一种表面识别方法来实现,在运动期间该表面识别方法在位于距所述表面的一定距离处实施,该方法的特征在于以下步骤:
a)提供以视线为中心的探测区域;
b)根据距表面的所述距离在所提供的探测区域中测量参量;
c)估算垂线到表面的方向,从而基于所测量的参量估算距表面的最小距离方向;
d)沿与所述垂线的方向间隔确定的重新定向角γ的方向对来自探测区域的视线重新定向。
根据优选的实施例,在任何技术上可能的组合的情况下,根据本发明的方法包括以下特征中的一个、数个或所有特征:
-步骤b)包括对光流进行测量,并且步骤c)包括:
i)通过对光流测量结果的回归分析,尤其是通过最小二乘法,确定探测区域的视线的定向的光流的函数;以及
ii)优选地,通过所述函数的微分,确定探测区域的视线的定向,所述函数为此具有最大值;
-该方法通过上述限定的装置或上述限定的微型无人机来执行。
附图说明
通过阅读参照附图进行的以下详细说明,本发明将被更好地理解,在附图中:
图1为根据本发明的第一示例性实施例的直升机类型的微型无人机的简化的透视图;
图2为示出了本发明中使用的坐标系和参量的示意图;
图3示出了根据本发明的三个反馈回路,其分别对微型无人机的前进的线速度和高度以及微型无人机的地形探测头的定向进行控制;
图4a)和图4b)示出了根据本发明的障碍物探测的改进;
图4c)和图4d)示出了光流根据光流传感器的探测区域的视线的定向所发生的演变,以及由包含在光流传感器中的腹侧局部运动传感器的组获得的光流测定点;
图5示出了常规的相对于其主体具有固定探测头的微型无人机以及根据本发明的从倾斜的地貌中穿过的微型无人机;
图6为根据本发明的第二示例性实施例的直升机类型的微型无人机的简化的透视图;以及
图7和图8示出了根据本发明的对微型无人机的探测头的定向进行控制的反馈回路的两种优选的替代性实施例。
具体实施方式
总论
优选地,本发明应用于大型飞行无人机、微型无人机以及配备有光流传感器的纳米无人机。然而,本发明并不限于此。有利地,本发明可应用于在距表面的一定距离处移动的其他飞行器,如机器鱼,太空船等。
除了光流传感器之外,诸如超声波传感器、激光传感器、雷达传感器、声纳传感器等之类的距离传感器,或对取决于距离的特性进行测量的传感器(诸如基于电气方向的传感器)也可在本发明的上下文中被使用。
第一实施例
图1示出了根据本发明的微型无人机2。该微型无人机(重量约为80克)是具有跨度约为50cm的两个旋翼4、6的直升机。微型无人机2能够通过基于光流测量结果对它的线性前进速度和高度进行控制来自主地飞行。该微型无人机尤其能够追随地面和天花板,并且能够降落。该微型无人机具有的特性在于能够无需惯性地面参考系中的测量结果而进行航行。
尤其当地貌陡峭时或在具有建筑物的环境中时和/或当GPS导航是不可能或不期望的时,这种类型的微型无人机或纳米无人机可适用于搜索、侦察或救援任务。
除了两个旋翼4、6,微型无人机2还包括两个电机8、10、主体12以及地面识别装置14,两个电机8、10用于驱动旋翼。主体12限定出纵向轴线X-X。该主体包括印刷电路板16以及印刷电路板16的加固杆18,优选地,加固杆18由碳纤维制成。优选地,加固杆18具有约25cm的长度。优选地,对微型无人机2的螺距速度进行测量的陀螺测试仪20被定位在印刷电路板16上。
地面识别装置14在图1中由虚线限定。该地面识别装置包括地形探测头22、探测区域定向系统24以及对微型无人机2进行控制的控制器26。
地形探测头22限定出连接至探测头的坐标系L,优选地,该坐标系L是标准正交的,该坐标系L具有前进轴Xe、偏航轴Ye、上升轴Ze以及位于探测头22的中心处的原点E(参见图2)。
在图1和图2所示的示例中,探测头22设置有分布于其上的四个光流传感器28。可以看到能够测量前腹侧光流ωva的前腹侧传感器28.1、能够测量后腹侧光流ωvd的后腹侧传感器28.2、能够测量前背侧光流ωda的前背侧传感器28.3以及能够测量后背侧光流ωdd的后背侧传感器28.4。每个光流传感器28覆盖以视线ZC为中心的探测区域ZV。优选地,每个光流传感器28包括以已知的角度隔开的一组的五个局部运动传感器。
应当指出的是,探测头22还可具有侧向光流传感器。
在一个替代性实施例中,探测头22还具有在飞行期间测量空速的空速指示器30。另外,探测头22可配备有诸如GPS传感器或陀螺测试仪之类的陀螺稳定传感器。这些传感器使得能够将微型无人机2在飞行期间的频繁倾斜运动考虑在内,从而改善光流传感器28的测量结果。
在另一替代性实施例中,探测头22可包括具有照相机的光流传感器,该照相机具有小视野或处于极大的角度。光流传感器还可包括照相机和反射镜的组合以创建全景视场。
在根据图1的实施例中,用于对探测区域ZV进行定向的系统24包括与减速齿轮34相结合的电机32,优选地,电机32为步进电机。电机32使得探测头22能够绕偏航轴Ye旋转,从而更改光流传感器28的探测区域ZV。
控制器26是定位在印刷电路板16上的微控制器。
参照图2,现在我们将确定在本发明的上下文中所使用的几何参量。图2示出了在具有局部斜线P和表面S的地形T上方飞行的微型无人机2。
应当指出的是,在本发明的上下文中,术语“地形”是指微型无人机被要求在飞行期间跟随的任何类型的地貌或界面。具体地,该地貌或界面可包括地面、天花板、宽广水域的表面、墙壁、海床等。
附图标记R指示具有原点O和三个轴Xo(横向)、Yo(纵向)和Zo(竖直)的地面惯性参考系。附图标记Φ指示探测头22的上升轴Ze和光流传感器28的探测区域ZV的视线ZC之间的仰角。优选地,仰角Φ约为23°,并且探测区域ZV覆盖大约24°乘以12°的区域。
矢量V表示微型无人机2的瞬时线速度。Ψ是矢量V和探测头22的前进速度Xe之间的角度。附图标记Vx指示线速度V的沿前进轴Xe的分量,Vy指示线速度V的沿偏航轴Ye的分量,以及Vz指示线速度V的沿上升轴Ze的分量。
角度α是由微型无人机2飞行越过的地形T的局部斜线P和地面参考系R的水平线Xo-Yo之间的角度。
距离D表面是地形T的表面S和探测头22的中心E之间的沿法线N至地形T的斜线P的距离。
角度θ螺距是微型无人机2的纵向轴线X-X和参考系R的地面基准面的水平线Xo-Yo之间的角度。
角度θ头是探测头22的前进轴Xe和地面参考系R的水平线Xo-Yo之间的角度。
角度θEiR是微型无人机2的纵向轴线X-X和探测头22的前进角度Xe之间的角度。
角度θ头/斜率是探测头22的前进轴Xe和地形T的局部斜线P之间的角度。
图3示出了根据本发明的安装在微控制器26中的导航算法A的框图。算法A包括:
-微型无人机2的前进线速度Vx的反馈回路B1,
-微型无人机2的高度的反馈回路B2,即微型无人机2与地形T的距离D表面的反馈,以及
-光流传感器28的探测区域ZV的定向的反馈回路B3。
每个反馈回路B1、B2、B3由虚线界定。
根据本发明的反馈回路B2与IROS文章中描述的相应反馈回路相同。对于这种反馈回路的详细解释可参考该文章,该文章的相应内容被结合到本说明书中。
根据本发明的反馈回路B1能够与IROS文章中描述的相应反馈回路做比较。该根据本发明的反馈回路具体还包括前进控制器35。对这两个反馈环路的相同元件的详细说明可参考该文章,该文章的相应内容被结合到本说明书中。
与从IROS文章中已知的前进线速度的反馈回路相比,根据本发明的反馈回路B1进一步通过使用在反馈回路B1交错的两个附加的反馈回路B4、B5并且通过分别使用空速控制器36和螺距速度控制器38来考虑来自空速指示器30和陀螺测试仪20的测量结果。
回路B1、B4和B5以如下方式配合:
基于测得的腹侧光流和背侧光流的总和ωvtrl+ωdrsl(其中,ωvtrl与(ωva+ωvd)成正比以及ωdrsl与(ωda+ωdd)成正比)以及设定点值ω设定点总和FO之间的比较的结果,前进控制器35生成空速设定点值。然后,将空速设定点值与由空速指示器30测量的空速进行比较。作为该比较的结果,空速控制器36产生微型无人机2的螺距速度的设定点值。然后,将螺距速度设定点值与由陀螺测试仪20测得的螺距速度进行比较。基于该比较的结果,螺距速度控制器38确定两个旋翼之间的推力的差ΔΩ旋翼,即有必要获得期望的前进线速度。
现在,我们将描述光流传感器28的探测区域ZV的定向的新的反馈回路B3。
该反馈回路B3的基本思想通过图4a)和图4b)示出。图4a)和图4b)示出了微型无人机2飞行越过具有斜线P的地形T,该斜线P具有角度α并且终止于中断部u。人们还可看到腹侧光流传感器的探测区域ZV。
在图4b)中,微型无人机2的探测头22相对于主体12是固定的,以使得探测头22的前进轴Xe仍平行于主体12的纵向轴线X-X。可以看到,当飞行越过斜线P时,与飞行越过平坦地形相比,光流传感器的探测区域ZV相对于地形T朝向后部定向。因此,微型无人机2在位置Xnr中探测中断部u。
申请人已发现,根据参考系L的局部平面中的由光流传感器探测的最大光流的方向,地形中的中断部的探测以及微型无人机2的导航大致通过旋转探测头22从而旋转光流传感器的探测区域ZV而得到改善。事实上,尤其在导致微型无人机2跟随地形T的反馈回路B2存在的情况下,最大光流方向对应于探测头22的中心E与地形T的表面S之间的距离最小时的方向。换句话说,最大光流方向M与法线N到地形T的表面S的、穿过探测头22的中心E的方向一致。也可以说,最大光流的方向是“看起来”位于被飞越的地形T的表面S上的右侧的方向。
随后,最大光流方向M通过其与上升轴Ze支撑的角度在参考系L的局部平面中被识别。
根据本发明,探测头22通过使用电机32来旋转以使得前腹侧传感器28.1的探测区域ZV的视线ZC与最大光流方向M间隔确定的重新定向角γ。重新定向角γ被设定成使得在微型无人机2跟随地形T飞行时前侧控制传感器28.1“看起来”是足够向前的。优选地,重新定向角γ介于0°和90°之间,并且尤其优选地,重新定向角γ大致上等于23°。
有利地,针对重新定向角γ选择仰角Φ(即,探测头22的上升轴Ze与腹侧光流传感器28.1的探测区域ZV视线ZC之间的固定角)。事实上,在这种情况下,反馈回路B3将探测头22的前进轴Xe保持成与微型无人机2飞行越过的地形T的局部斜线P平行。
图4a)示出了其反馈回路B3起作用时的微型无人机2,即,当探测头22被闭环控制成绕偏航轴Ye旋转以便遵循设定在仰角Φ的值处的重新定向角γ时的微型无人机2。可以看到,前腹侧光流传感器28.1的探测区域ZV相对于图4b)被拉直。因此,微型无人机2较早地在位置Xr中探测出中断部u。
图4c)和图4d)示出了函数:ω/ωmax=f(Φ),即,角Φ的相对光流ω/ωmax相对于上升轴Ze的相关性。图4c)示出了在图4a)所示情况下的f(Φ),并且,图4d)示出了在图4b)所示的情况下的f(Φ)。每个曲线图4c)和4d)中示出了前腹侧光流传感器28.1的五个局部运动传感器的测量点pma以及后腹侧光流传感器28.2的五个局部运动传感器的测量点pmd。
数学基础
现在,我们将概述根据本发明的反馈回路B3的数学基础。
根据由T.怀特塞德等人发表在自然科学审查(scientific review Nature),225:94-95的文章“模糊地带(Blur zone)”,已知的是,根据下面的等式,光流ω随每个光流传感器28相对于探测头22的参考系L的局部平面的定向Φ而变化:
等式1
假定光流传感器28向下定向,能够几何地证明距离D(Φ)取决于飞行越过的地形T的斜线P的角度α、距离D表面、角θ头/斜率以及仰角Φ:
等式2
使用等式1和等式2,推导出:
等式3
由于我们期待最大光流的方向以便确定θ头/斜率,因此,我们与等式3区分开:
等式4
随后针对下一等式获得余弦函数的最大值:
等式5
如等式5中可见的,当微型无人机2在运转时,光流的最大值不会在探测头平行于所跟随的表面时出现,但会在取决于角θ头/斜率和角Ψ的角度处出现。
假设:速度矢量V总是平行于所跟随的表面:
等式6
Ψ=θ头/斜率
实际上,反馈回路B2使用来自光流传感器28的光流测量结果以维持微型无人机2的前进速度和与表面S的距离D表面之间的恒定的比率,这导致跟随地形并且速度矢量因此与所跟随的表面对准。
在该情况下,等式5变成:
等式7
因此,估算的重新定向角可被用于使探测头22重新定向成与所跟随的表面平行,这是因为导致θ头/斜率=0。
根据等式3,在最大的光流位置的附近,光流根据下一等式变化:
等式8
因此,应当针对所有的光流传感器28获取测量结果,这些光流传感器彼此间隔已知的角度,这些测量结果应当被用于确定角θ头/斜率。
在以下函数中寻求系数和
这给出了光流测量结果的最小二乘法的范围内的最佳逼近。这容易地在微型无人机26中实现,因为能够通过使用在0附近的泰勒级数展开的二次多项式函数来估算平方余弦函数:
等式9
这等同于:
等式10
ω(Φ)≈a×Φ'2+b×Φ'+c
X=[Φ′2,Φ′,1]被限定,并且,通过使用一组光流测量结果Γ,通过最小二乘法限定出系数[a,b,c]:
等式11
[a,b,c]=inv(X*X′)*X*Γ′
在该表达式中,仅Γ取决于光流测量结果,而其他是恒定的并仅取决于每个光流测量结果在参考系L的局部平面中的固定定向。
矩阵乘法足以确定系数[a;b;c],并且随后,能够使用等式9和10来确定角为以下内容:
等式12
在模拟期间,结果表明,随着噪声增加至光流测量结果,可能造成的错误的测量结果,这导致探测头22在反馈期间进行振荡。
为消除错误的测量结果,计算“置信度指数(confidence index)”:
等式13
置信度指数的减小对应于光流测量结果和近似平方余弦函数之间的较高的相似性。如果置信度指数低于阈值,那么仅验证角度
试验结果
图5示出了使用两个微型无人机K1和K2完成的试验。微型无人机K1装备有根据本发明的不断使其探测头22重新定向成与地面平行的反馈回路B3,而微型无人机K2的探测头22相对于主体12是固定的。
两个微型无人机K1和K2的任务是在包括突起地貌H的陡峭环境Q中航行。应注意到,微型无人机K2较晚地探测出突起地貌H,因此撞击到该突起地貌H。然而,使用根据本发明的探测区域重新定向的方法,微型无人机K1被控制以越过突起地貌H。图5示出了微型无人机K1和K2的轨迹I1(虚线)和I2(实线)。
第二实施例
图6示出了根据本发明的微型无人机2的第二实施例。这里,我们仅关注相对于根据图1的第一实施例的不同之处。对于两个实施例共有的元件,可参照以上的描述。
在第二实施例中,探测头22通过杆40连接到主体12。因此,探测头22和主体12之间没有相对运动是可能的。探测头22被安装在主体12上,以使得前进轴Xe大致上平行于主体12的纵向轴线X-X。
光流传感器28在这里由84×15个光电探测器的矩阵42组成,这些光电探测器绕偏航轴Ye大体上覆盖约360°×60°的探测场。在多个光电检测器当中选择具有四个组G1至G4的子集,该四个组G1至G4覆盖的探测区域ZV类似于根据图1的第一实施例的那些探测区域。
反馈回路B3被安装在该第二微型无人机中以便实时选择光电探测器的不同子集以根据重新定向角γ来测量光流。
传感器的探测区域ZV的定向的反馈回路B3的优选方案
图7示出了反馈回路B3的示例,并且其可实施在根据图1和图6的微型无人机2中。在第一步骤101期间,光流传感器28在若干探测区域ZV中的一个或两个维度(1D或2D)中测量出光流ω。在第二步骤102期间,微控制器26估算出垂直于表面S的方向,该表面S在探测头22的参考系L的平面中被飞行越过。在第三步骤103期间,探测头22被重新定向,以便将其前进轴Xe垂直于飞越表面S处的垂线对准。在第三步骤103之后,将反馈回路B3从第一步骤101重新开始,等等。
图8示出了使用来自距离传感器而非光流传感器的测量结果的反馈环路B3的替代性实施例。
Claims (19)
1.一种表面(S)识别装置(14),用于距所述表面(S)的一定距离处的移动飞行器(2)的自主运动,所述表面识别装置(14)包括:
a)表面探测头(22),所述表面探测头(22)限定出固定至所述表面探测头的坐标系(L),所述坐标系(L)具有原点(E)、前进轴(Xe)、偏航轴(Ye)、上升轴(Ze),所述原点(E)位于所述表面探测头(22)的中心处,所述表面探测头(22)包括用于参量(ω)的至少一个传感器(28),所述参量(ω)取决于所述表面探测头的中心(E)距所述表面(S)的距离(Dsurface),每个所述传感器(28)覆盖以视线(ZC)为中心的探测区域(ZV);
b)定向系统(24),所述定向系统(24)用于通过使所述探测区域绕所述偏航轴(Ye)旋转来对每个所述传感器(28)的探测区域(ZV)进行定向;以及
c)控制器(26),所述控制器(26)适用于接收和处理来自每个所述传感器(28)的信号并基于所述信号来控制用于对所述探测区域(ZV)进行定向的定向系统(24),
其特征在于,所述控制器(26)被配置成:基于所述信号在所述坐标系(L)中估算垂线(N)到所述表面(S)的方向,并且通过使用所述定向系统(24)来将每个所述传感器(28)的观察区域的视线(ZC)旋转至与所述垂线(N)的方向间隔确定的重新定向角(γ)的方向中。
2.根据权利要求1所述的表面识别装置,其中,所述重新定向角(γ)介于0°和90°之间。
3.根据权利要求1所述的表面识别装置,其中,每个所述传感器(28)是光流传感器,并且其中,所述控制器(26)被配置成:基于由每个光流传感器(28)传递的信号通过确定最大光流方向(M)来估算所述垂线(N)到所述表面(S)的方向。
4.根据权利要求3所述的表面识别装置,其中,所述控制器(26)被配置成通过执行以下步骤来确定最大光流方向(M):
a)通过由每个所述光流传感器(28)提供的光流信号的回归分析,从所述探测区域(ZV)的视线(ZC)在所述坐标系(L)中的定向(Φ)确定所述光流的函数(ω=f(Φ));以及
b)确定所述探测区域(ZV)的视线(ZC)的定向所述函数(ω=f(Φ))为此具有最大值。
5.根据权利要求1至4中任一项所述的表面识别装置,其中,所述控制器(26)进一步被配置成:基于所述信号计算置信度指数,并基于所述置信度指数的值对所述垂线(N)到所述表面(S)的方向的估算进行验证或拒绝。
6.根据权利要求1至4中任一项所述的表面识别装置,其中,所述表面探测头(22)包括四个光流传感器,即,前腹侧传感器(28.1)、后腹侧传感器(28.2)、前背侧传感器(28.3)以及后背侧传感器(28.4)。
7.根据权利要求1至4中任一项所述的表面识别装置,其中,定向系统(24)包括致动器(32),所述致动器(32)能够使表面探测头(22)绕所述偏航轴(Ye)旋转。
8.根据权利要求1至4中任一项所述的表面识别装置,设置有光流测量组件,所述光流测量组件包括绕所述偏航轴(Ye)大体覆盖360°x60°的探测场的光电探测器的矩阵(42),并且其中,所述探测区域的定向系统能够选择所述光电探测器的一个或多个子集(G1,G2,G3,G4)来表示所述传感器中的每个。
9.根据权利要求1至4中任一项所述的表面识别装置,其中,所述表面探测头(22)还配备有所述表面探测头的至少一个陀螺仪稳定传感器以在飞行期间补偿所述移动飞行器的旋转运动。
10.一种具有自主运动的航空的微型无人机(2),包括根据权利要求7所述的表面识别装置,控制器(26)被配置成控制致动器(32)以便将表面探测头(22)的上升轴(Ze)沿垂线(N)到表面(S)的估算方向对准,从而将所述表面探测头(22)的前进轴(Xe)保持为与所述航空的微型无人机(2)飞越过的所述表面(S)的局部斜线(P)平行。
11.根据权利要求10所述的航空的微型无人机,进一步包括用于控制所述航空的微型无人机(2)的前进线速度的陀螺测试仪(20)或空速指示器(30)或两者。
12.一种采用根据权利要求1所述的表面识别装置并应用于移动飞行器的表面(S)识别方法,所述表面识别方法的特征在于以下步骤:
a)提供以视线(ZC)为中心的探测区域(ZV);
b)根据距所述表面(S)的所述距离(Dsurface)在所提供的探测区域(ZV)中测量参量(ω);
c)估算垂线(N)到所述表面(S)的方向,从而基于所测量的参量(ω)估算距所述表面(S)的最小距离方向;
d)沿与所述垂线(N)的方向间隔确定的重新定向角(γ)的方向对所述探测区域(ZV)的视线(ZC)重新定向。
13.根据权利要求12所述的表面识别方法,其中,步骤b)包括对光流进行测量,并且步骤c)包括:
i)通过光流测量结果的回归分析,确定所述探测区域(ZV)的视线(ZC)的定向(Φ)的光流的函数(ω=f(Φ));以及
ii)确定所述探测区域的视线(ZC)的定向所述函数(ω=f(Φ))为此具有最大值。
14.根据权利要求12或13所述的表面识别方法,通过根据权利要求1所述的表面识别装置或根据权利要求10所述的航空的微型无人机来执行。
15.根据权利要求4所述的表面识别装置,其中,步骤a)通过使用最小二乘法来执行。
16.根据权利要求4所述的表面识别装置,其中,步骤b)通过所述函数(ω=f(Φ))的微分来执行。
17.根据权利要求7所述的表面识别装置,所述致动器为步进电机。
18.根据权利要求13所述的表面识别方法,其中,步骤i)通过使用最小二乘法来执行。
19.根据权利要求13所述的表面识别方法,其中,步骤ii)通过所述函数(ω=f(Φ))的微分来执行。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1360211A FR3012231B1 (fr) | 2013-10-18 | 2013-10-18 | Dispositif et procede de reperage de terrain en vol pour microdrone |
FR1360211 | 2013-10-18 | ||
PCT/EP2014/072229 WO2015055769A1 (fr) | 2013-10-18 | 2014-10-16 | Dispositif et procédé de repérage de terrain en vol pour microdrone |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106575120A CN106575120A (zh) | 2017-04-19 |
CN106575120B true CN106575120B (zh) | 2019-08-09 |
Family
ID=50478490
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201480057390.4A Expired - Fee Related CN106575120B (zh) | 2013-10-18 | 2014-10-16 | 用于微型无人机的飞行地形识别的方法和装置 |
Country Status (5)
Country | Link |
---|---|
US (1) | US10061319B2 (zh) |
EP (1) | EP3058431B1 (zh) |
CN (1) | CN106575120B (zh) |
FR (1) | FR3012231B1 (zh) |
WO (1) | WO2015055769A1 (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102014211896A1 (de) * | 2014-06-20 | 2015-12-24 | Robert Bosch Gmbh | Verfahren zur Überwachung einer Fahrzeugsteuerung |
US9944404B1 (en) * | 2015-03-23 | 2018-04-17 | Amazon Technologies, Inc. | Prognostic failure detection system |
FR3037672B1 (fr) * | 2015-06-16 | 2017-06-16 | Parrot | Drone comportant des moyens perfectionnes de compensation du biais de la centrale inertielle en fonction de la temperature |
US10417918B2 (en) * | 2016-01-20 | 2019-09-17 | Honeywell International Inc. | Methods and systems to assist in a search and rescue mission |
FR3057347B1 (fr) * | 2016-10-06 | 2021-05-28 | Univ Aix Marseille | Systeme de mesure de la distance d'un obstacle par flux optique |
US20180186472A1 (en) * | 2016-12-30 | 2018-07-05 | Airmada Technology Inc. | Method and apparatus for an unmanned aerial vehicle with a 360-degree camera system |
US10353401B2 (en) * | 2017-05-01 | 2019-07-16 | EAVision Corporation | Detecting and following terrain height autonomously along a flight path |
US10867398B2 (en) * | 2017-11-21 | 2020-12-15 | Reliance Core Consulting LLC | Methods, systems, apparatuses and devices for facilitating motion analysis in an environment |
EP3487175A1 (en) * | 2017-11-21 | 2019-05-22 | Reliance Core Consulting LLC | Methods and systems for detecting motion corresponding to a field of interest |
CN109074098B (zh) * | 2017-12-18 | 2023-03-10 | 深圳市大疆创新科技有限公司 | 无人机的控制方法、控制装置、无人机及农业无人机 |
CN109506662B (zh) * | 2018-10-30 | 2020-09-18 | 北京控制工程研究所 | 一种小天体着陆初始对准方法、其相对导航基准确定方法及装置 |
WO2023082255A1 (zh) * | 2021-11-15 | 2023-05-19 | 深圳市大疆创新科技有限公司 | 无人飞行器的控制方法、无人飞行器及存储介质 |
CN115753786A (zh) * | 2022-10-31 | 2023-03-07 | 杭州国电大坝安全工程有限公司 | 建筑体裂缝的表面勘测方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1669048A (zh) * | 2002-06-12 | 2005-09-14 | 国家科学研究中心 | 定位表面冲击的方法及其实现设备 |
GB2453425A (en) * | 2007-10-03 | 2009-04-08 | Hamilton Sundstrand Corp | A system for measuring rotor imbalance via blade clearance sensors |
CN102052884A (zh) * | 2009-10-28 | 2011-05-11 | 约翰尼斯海登海恩博士股份有限公司 | 探测系统及其工作方法 |
CN102401646A (zh) * | 2010-07-19 | 2012-04-04 | 通用电气公司 | 基于结构光测量的方法 |
CN102483317A (zh) * | 2009-05-07 | 2012-05-30 | 卡尔.马尔控股有限公司 | 测量表面轮廓的方法和装置 |
CN102798361A (zh) * | 2011-05-26 | 2012-11-28 | 约翰尼斯海登海恩博士股份有限公司 | 探测系统和用于运行探测系统的方法 |
CN202995457U (zh) * | 2012-11-27 | 2013-06-12 | 福建省泉州市第七中学 | 自旋式变结构多功能越障探测器 |
CN103148804A (zh) * | 2013-03-04 | 2013-06-12 | 清华大学 | 一种基于激光扫描的室内未知结构识别方法 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE2636769B1 (de) * | 1976-08-14 | 1977-11-10 | Zeiss Carl Fa | Vorrichtung zur messung der geschwindigkeit und/oder der bewegungsrichtung einer bildstruktur |
US7280134B1 (en) * | 1998-01-26 | 2007-10-09 | Thales Avionics, Inc. | Landscape camera system with electronic field of view switching |
US6480763B1 (en) * | 2000-12-14 | 2002-11-12 | Sikorsky Aircraft Corporation | Method and system for providing an aircraft drift advisory |
FR2844607B1 (fr) * | 2002-09-16 | 2004-12-10 | Centre Nat Rech Scient | Systeme d'assistance au pilotage de l'altitude et de la vitesse horizontale, perpendiculaire a l'aplomb, d'un aeronefs equipes de ce systeme |
DE50309811D1 (de) | 2002-09-23 | 2008-06-19 | Captron Elect Gmbh | Mess- und stabilisierungsystem f r maschinell steuerbare veh ikel |
US7000883B2 (en) * | 2003-01-17 | 2006-02-21 | The Insitu Group, Inc. | Method and apparatus for stabilizing payloads, including airborne cameras |
DE102013109392A1 (de) * | 2013-08-29 | 2015-03-05 | Airbus Defence and Space GmbH | Schnellfliegendes, senkrechtstartfähiges Fluggerät |
US9739611B2 (en) * | 2013-10-09 | 2017-08-22 | Mid-Continent Instruments Co., Inc. | Aircraft instrumentation module |
WO2016003530A2 (en) * | 2014-05-08 | 2016-01-07 | Northrop Grumman Systems Corporation | Vertical takeoff and landing (vtol) unmanned aerial vehicle (uav) |
US9845165B2 (en) * | 2014-07-16 | 2017-12-19 | Airogistic, L.L.C. | Methods and apparatus for unmanned aerial vehicle landing and launch |
-
2013
- 2013-10-18 FR FR1360211A patent/FR3012231B1/fr not_active Expired - Fee Related
-
2014
- 2014-10-16 WO PCT/EP2014/072229 patent/WO2015055769A1/fr active Application Filing
- 2014-10-16 US US15/030,351 patent/US10061319B2/en active Active
- 2014-10-16 EP EP14789213.7A patent/EP3058431B1/fr active Active
- 2014-10-16 CN CN201480057390.4A patent/CN106575120B/zh not_active Expired - Fee Related
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1669048A (zh) * | 2002-06-12 | 2005-09-14 | 国家科学研究中心 | 定位表面冲击的方法及其实现设备 |
GB2453425A (en) * | 2007-10-03 | 2009-04-08 | Hamilton Sundstrand Corp | A system for measuring rotor imbalance via blade clearance sensors |
CN102483317A (zh) * | 2009-05-07 | 2012-05-30 | 卡尔.马尔控股有限公司 | 测量表面轮廓的方法和装置 |
CN102052884A (zh) * | 2009-10-28 | 2011-05-11 | 约翰尼斯海登海恩博士股份有限公司 | 探测系统及其工作方法 |
CN102401646A (zh) * | 2010-07-19 | 2012-04-04 | 通用电气公司 | 基于结构光测量的方法 |
CN102798361A (zh) * | 2011-05-26 | 2012-11-28 | 约翰尼斯海登海恩博士股份有限公司 | 探测系统和用于运行探测系统的方法 |
CN202995457U (zh) * | 2012-11-27 | 2013-06-12 | 福建省泉州市第七中学 | 自旋式变结构多功能越障探测器 |
CN103148804A (zh) * | 2013-03-04 | 2013-06-12 | 清华大学 | 一种基于激光扫描的室内未知结构识别方法 |
Non-Patent Citations (1)
Title |
---|
基于MIMO线阵天线的无人机载下视3D-SAR成像研究;陈捷;《万方学术》;20130424;第8-39页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106575120A (zh) | 2017-04-19 |
EP3058431A1 (fr) | 2016-08-24 |
US20160259337A1 (en) | 2016-09-08 |
FR3012231A1 (fr) | 2015-04-24 |
WO2015055769A1 (fr) | 2015-04-23 |
US10061319B2 (en) | 2018-08-28 |
EP3058431B1 (fr) | 2020-04-15 |
FR3012231B1 (fr) | 2016-01-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106575120B (zh) | 用于微型无人机的飞行地形识别的方法和装置 | |
US11724805B2 (en) | Control method, control device, and carrier system | |
Zingg et al. | MAV navigation through indoor corridors using optical flow | |
Shen et al. | Vision-based state estimation for autonomous rotorcraft MAVs in complex environments | |
CN110780683B (zh) | 用于交通工具的化学感测自主系统 | |
Achtelik et al. | Visual-inertial SLAM for a small helicopter in large outdoor environments | |
US10474152B2 (en) | Path-based flight maneuvering system | |
Mohta et al. | Vision-based control of a quadrotor for perching on lines | |
CN105759829A (zh) | 基于激光雷达的微型无人机操控方法及系统 | |
JP2017075863A (ja) | 飛行型検査装置および検査方法 | |
Lippiello et al. | MAV indoor navigation based on a closed-form solution for absolute scale velocity estimation using optical flow and inertial data | |
Ling et al. | Autonomous maritime landings for low-cost vtol aerial vehicles | |
WO2007124014A2 (en) | System for position and velocity sense and control of an aircraft | |
Weiss et al. | 4dof drift free navigation using inertial cues and optical flow | |
Lasmadi et al. | Inertial navigation for quadrotor using kalman filter with drift compensation | |
Becker et al. | In-flight collision avoidance controller based only on OS4 embedded sensors | |
JP6592680B1 (ja) | 無人航空機 | |
Bavle et al. | A flight altitude estimator for multirotor UAVs in dynamic and unstructured indoor environments | |
Weiss et al. | Inertial optical flow for throw-and-go micro air vehicles | |
Hui et al. | Trajectory tracking and formation flight of autonomous UAVs in GPS-denied environments using onboard sensing | |
JP6469492B2 (ja) | 自律移動ロボット | |
JP7063578B2 (ja) | 飛行装置 | |
JP6832394B2 (ja) | 自己位置推定装置、自己位置選択装置、及び学習器 | |
Zhang et al. | Multi-sensory motion estimation and control of a mini-quadrotor in an air-ground multi-robot system | |
Lee et al. | Attitude control of quadrotor with on-board visual feature projection system |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20190809 |