CN114384921B - 一种基于无人机母车的车载无人机的升降方法 - Google Patents
一种基于无人机母车的车载无人机的升降方法 Download PDFInfo
- Publication number
- CN114384921B CN114384921B CN202210029853.2A CN202210029853A CN114384921B CN 114384921 B CN114384921 B CN 114384921B CN 202210029853 A CN202210029853 A CN 202210029853A CN 114384921 B CN114384921 B CN 114384921B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- vehicle
- parent
- preset
- 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
- 238000000034 method Methods 0.000 title claims abstract description 55
- 238000005070 sampling Methods 0.000 claims description 22
- 238000013459 approach Methods 0.000 claims description 15
- 230000001133 acceleration Effects 0.000 claims description 14
- 238000001914 filtration Methods 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000011217 control strategy Methods 0.000 claims description 4
- 230000001360 synchronised effect Effects 0.000 claims description 4
- 230000008569 process Effects 0.000 abstract description 12
- 238000004891 communication Methods 0.000 description 11
- 238000010586 diagram Methods 0.000 description 8
- 238000012986 modification Methods 0.000 description 5
- 230000004048 modification Effects 0.000 description 5
- 238000013461 design Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 238000013475 authorization Methods 0.000 description 3
- 238000012937 correction Methods 0.000 description 3
- 238000001514 detection method Methods 0.000 description 3
- 230000009191 jumping Effects 0.000 description 3
- 230000000007 visual effect Effects 0.000 description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 2
- 239000003086 colorant Substances 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 239000000446 fuel Substances 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 239000003550 marker Substances 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 238000007781 pre-processing Methods 0.000 description 2
- 238000012795 verification Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000000575 pesticide Substances 0.000 description 1
- 239000003208 petroleum Substances 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000007921 spray Substances 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
- G05D1/0653—Rate of change of altitude or depth specially adapted for aircraft during a phase of take-off or landing
- G05D1/0676—Rate of change of altitude or depth specially adapted for aircraft during a phase of take-off or landing specially adapted for landing
- G05D1/0684—Rate of change of altitude or depth specially adapted for aircraft during a phase of take-off or landing specially adapted for landing on a moving platform, e.g. aircraft carrier
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明提供一种基于无人机母车的车载无人机的升降方法,具体包括:用户根据需求,通过无人车母车发送起飞或降落的指令给车载无人机;车载无人机对接收的指令进行解析并根据指令执行采用相应的措施并反馈执行的信息给无人机母车;无人机母车根据车载无人车反馈执行的信息采取对应的措施配合车载无人机进行起飞或降落。本发明提供的技术方案中,无人机母车在降落过程中,针对不同的阶段,采用多个预设不同的距离阈值与对应的跟踪标识进行搭配,同时设计对应控制方案,使得无人机能够易于控制并且精确降落至无人机母车上。
Description
技术领域
本发明涉及车载无人机技术领域,特别是涉及基于无人机母车的车载无人机的升降方法。
背景技术
目前,无论是军用还是民用,无人机都有着广泛的应用。民用中,无人机用于拍照,如大疆无人机,通过遥控器能够操作无人机飞向指定位置进行航拍。如在农业中利用无人机喷洒农药。但是目前的无人机无论是起飞还是降落,都是需要人为操控。如大疆无人机降落,用户拿着遥控器将无人机飞行到指定位置,然后悬停后缓慢降落。但是无人机的续航里程比较短,并且受限于通信距离,导致限制其的应用。如当需要无人机远距离执行拍照或搜索或目标跟踪时,由于无人机的距离续航受到限制,导致其难以真正执行。随着智能汽车的发展,使得无人机母车和无人机搭配使用成为现实,但是现阶段,由于车的目标较小,而且还有可能是正在行驶的,驾驶员不能像以前那样,下车后拿着遥控器观察无人机手动操控,因此,需要提供一种利用无人机母车对其携载的无人机的起飞和降落的控制方法,以方便无人机顺利的从无人机母车中起飞或降落。
发明内容
基于现有技术中存在的缺陷,本发明提供一种基于无人机母车的车载无人机的升降方法,至少包括:
用户根据需求,通过无人车母车发送起飞或降落的指令给车载无人机;
车载无人机对接收的指令进行解析并根据指令执行采用相应的措施并反馈执行的信息给无人机母车;
无人机母车根据车载无人车反馈执行的信息采取对应的措施配合车载无人机进行起飞或降落。
一种基于无人机母车的车载无人机的升降方法,当无人车母车发送的指令为降落指令时,车载无人机接收到降落指令后,调整自身状态,调用升降模块开启降落模式;
获取无人机母车的位姿参数,计算车载无人机与无人机母车的当前距离d;
将当前距离d与预设的距离阈值相比,执行预设的标识跟踪和控制策略,实现精准降落。
一种基于无人机母车的车载无人机的升降方法,进一步地,判断当前距离d是否能够在捕获无人机母车的预设区间;若否,调整自身飞行参数逐步逼近无人机母车,等待预设的采样周期后,重新计算当前距离d,直至当前距离满足捕获无人机母车的预设期间;
若是,获取无人机母车的标识特征,根据标志特征从捕获的图像中查找无人机母车,根据标识特征跟踪无人机母车。
一种基于无人机母车的车载无人机的升降方法,进一步地,当前距离d大于第一预设距离阈值d1,则不满足捕获无人机母车的预设区间;
或当前距离d小于第一预设距离阈值d1但大于第二预设距离阈值d2,满足捕获无人机母车的预设区间,标识特征为第一标识特征,第一标识包括超大尺度的标识和或颜色标识。
或当前距离d小于第二预设距离阈值d2但大于第三阈值d3,满足捕获无人机母车的预设区间,标识特征为第二标识特征,第二标识包括大尺度标识但不包括颜色标识,第二标识特征的尺度小于第一标识特征。
一种基于无人机母车的车载无人机的升降方法,进一步地,调整自身飞行参数逐步逼近无人机母车,间隔采样周期获取无人机母车的位姿参数,计算车载无人机与无人机母车的当前距离d;
判断当前距离d是否能够在捕获无人机母车预设位置的降落标识点;
若否,调整自身飞行参数逐步逼近无人机母车,等待预设的采样周期后,重复当前距离计算与判断直至当前距离d满足捕获降落标识点;
若是,获取降落标识点,将降落标识点替换为跟随特征点;
其中,当前距离d小于第三预设距离阈值d3,则满足捕获无人机母车的预设位置降落标识点,降落标识点包括第三标识点。
一种基于无人机母车的车载无人机的升降方法,进一步地,调整自身飞行参数逐步逼近无人机母车,计算车载无人机与当前无人机母车的距离,判断当前距离是否满足降落距离;
若否,根据相机捕获第三标志点计算的位置参数以及无人机母车的速度和加速度调整自身飞行参数逐步逼近无人机母车,间隔采样周期获取相机的位姿参数,计算车载无人机与当前无人机母车的距离,重复当前距离计算与判断直至当前距离d满足降落距离。
若满足,则无人降落到无人机母车的预设位置。
一种基于无人机母车的车载无人机的升降方法,进一步地,当无人车母车发送降落指令给无人机时,车载无人机接收到降落指令后,开启降落模式;
在车载无人机降落阶段设置多个距离阈值和与距离阈值对应的捕获特征标识,计算无人机母车与车载无人机的当前距离d,将当前距离d与预设的多个距离阈值进行对比,根据比较结果使无人机追踪对应的特征标识。
一种基于无人机母车的车载无人机的升降方法,进一步地,所述多个距离阈值至少包括第一预设距离阈值d1,第二预设距离阈值d2、第三预设距离阈值d3;特征标识包括第一标识、第二标识、第三标识,其中,第一标识的尺度大于第二标识尺度,第二标识的尺度大于第三标识的尺度,第一标识还包括颜色标识。
一种基于无人机母车的车载无人机的升降方法,进一步地,第一标识包括超大尺度的标识和颜色标识,用于在车载无人机与无人机母车的距离d小于第一预设距离d1但大于第二预设距离阈值d2,车载无人机追踪无人机母车的特征标识;
第二标识包括大尺度标识但不包括颜色标识,用于车载无人机与无人机母车的距离小于第二预设距离阈值d2但大于第三预设距离阈值d3时,车载无人机追踪无人机母车的特征标识;
第三标识包括小尺度标识,用于车载无人机与无人机母车的距离小于第三预设距离阈值d3,车载无人机追踪的无人机母车的降落标识。
一种基于无人机母车的车载无人机的升降方法,进一步地,特征标识图形至少包括黑白相间的方块组成的图案或标识二维码或多维码或预设特征图案。
一种基于无人机母车的车载无人机的升降方法,进一步地,其中,第二标识和第三标识点的中心相同;设置第二标识的尺度至少大于5倍于第三标识。
一种基于无人机母车的车载无人机的升降方法,进一步地,若当前距离d大于第一阈值d1是,车载无人机采用比例P控制,反馈量采用当前距离d、车载无人机的当前运行速度V1和无人机母车的运行速度V2输入控制器,根据当前速度选择是否提升P控制增益Kp;
或若当前距离d小于等于第一预设距离阈值d1时,车载无人机采用PD控制,反馈量采用当前距离d、无人机的当前运行速度V1和无人机母车的运行速度V2,降低P控制增益Kp。
一种基于无人机母车的车载无人机的升降方法,进一步地,通过卡尔曼滤波,预测无人机母车和车载无人机各自的位置、速度、加速度,将位置、速度、加速度输入控制器,生成控制信号输入给车载无人机升降控制模块控制车载无人机。
一种基于无人机母车的车载无人机的升降方法,进一步地,在车载无人机和无人机母车之间的当前距离d小于第一预设距离阈值d1,卡尔曼滤波的预测的输入依赖于车载无人机和无人机母车的GPS和IMU,采样频率同步GPS的更新频率;
在车载无人机和无人机母车的之间的距离d大于第一预设距离阈值d1,d小于第二预设距离阈值d2,卡尔曼滤波的预测的输入依赖于相机的位姿参数和无人机母车的速度,采样频率同步于位姿参数更新的频率;
在车载无人机和无人机母车的之间的距离d小于第一预设距离阈值d3,卡尔曼滤波的预测的输入依赖于相机的位姿参数和无人机母车的速度以及IMU计算出的水平方向和垂直方向加速度,采样频率同步位姿参数更新的频率。
有益效果:
1.本发明提供的技术方案中,针对现有技术的缺陷,通过设计解码器和验证器和操作流程,对车载车人机和无人机母车的配对方案进行了设计,使得无人机母车和车载无人机能够安全配对,防止未经授权的无人机母车操控车载无人机,同时也防止型号不匹配的车载无人机与无人机母车相互配对。
2.设计无人机起飞和无人机降落在无人机母车的技术方案,在降落过程中,针对不同的阶段,采用多个预设不同的距离阈值与对应的跟踪标识进行搭配,同时设计对应控制方案,使得无人机能够易于控制并且精确降落至无人机母车上。
3.在跟踪标识上,根据距离设计多种不同的标识,使得无人机能够精准的追踪无人机母车的标识特征,避免因标识识别错误或识别不到标识导致降落失败。
附图说明
以下附图仅对本发明做示意性说明和解释,并不限定本发明的范围。
图1为本发明另一实施例中车载无人机和无人机母车的系统架构示意图。
图2为本发明另一实施例中车载无人机与无人机母车的配对方法示意图。
图3为本发明另一实施例中车载无人机起飞的控制方案流程。
图4为本发明另一实施例中车载无人机降落过程中跟踪无人机母车的标识中采用超大标识示意图。
图5为本发明另一实施例中车载无人机降落过程中跟踪无人机母车的标识中采用超大标识和颜色示意图。
图6为本发明另一实施例中车载无人机降落过程中跟踪无人机母车的标识中采用多个小尺度标志点示意图。
图7为本发明另一实施例中车载无人机降落过程中跟踪无人机母车的标识中采用多个小尺度标志点示意图。
图8为本发明另一实施例中车载无人机降落过程中跟踪无人机母车的降落标识。采用第三标识和第二标识。
图9为本发明另一实施例中车载无人机降落过程中根据当前距离与预设距离阈值的追踪与控制关系图。
具体实施方式
为了对本文的技术特征、目的和效果有更加清楚的理解,现对照附图说明本发明的具体实施方式,在各图中相同的标号表示相同的部分。为使图面简洁,各图中的示意性地表示出了与本发明相关部分,而并不代表其作为产品的实际结构。另外,为使图面简洁便于理解,在有些图中具有相同结构或功能的部件,仅示意性地绘示了其中的一个,或仅标出了其中的一个。
关于控制系统,功能模块、应用程序(APP)本领域技术人员熟知的是,其可以采用任何适当的形式,既可以是硬件也可以是软件,既可以是离散设置的多个功能模块,也可以是集成到一个硬件上的多个功能单元。作为最简单的形式,所述控制系统可以是控制器,例如组合逻辑控制器、微程序控制器等,只要能够实现本申请描述的操作即可。当然,控制系统也可以作为不同的模块集成到一个物理设备上,这些都不偏离本发明的基本原理和保护范围。
本发明中“连接”,即可包括直接连接、也可以包括间接连接、通信连接、电连接,特别说明除外。
本文中所使用的术语仅为了描述特定实施方案的目的并且不旨在限制本公开。如本文中所使用地,单数形式“一个”、“一种”、以及“该”旨在也包括复数形式,除非上下文明确地另作规定。还将理解的是,当在说明书中使用时,术语“包括”和/或“包含”是指存在有所陈述的特征、数值、步骤、操作、元件和/或组分,但是并不排除存在有或额外增加一个或多个其它的特征、数值、步骤、操作、元件、组分和/或其组成的群组。作为在本文中所使用的,术语“和/或”包括列举的相关项的一个或多个的任何和全部的组合
应当理解,此处所使用的术语“车辆”或“车辆的”或其它类似术语一般包括机动车辆,例如包括运动型多用途车辆(SUV)、公共汽车、卡车、各种商用车辆的乘用汽车,包括各种舟艇、船舶的船只,航空器等等,并且包括混合动力车辆、电动车辆、可插式混合动力电动车辆、氢动力车辆以及其它替代性燃料车辆(例如源于非石油的能源的燃料)。正如此处所提到的,混合动力车辆是具有两种或更多动力源的车辆,例如汽油动力和电力动力两者的车辆。
此外,本公开的控制器可被具体化为计算机可读介质上的非瞬态计算机可读介质,该计算机可读介质包含由处理器、控制器或类似物执行的可执行程序指令。计算机可读介质的示例包括,但不限于,ROM、RAM、光盘(CD)-ROM、磁带、软盘、闪存驱动器、智能卡和光学数据存储设备。计算机可读记录介质也可分布在通过网络耦合的计算机系统中,使得计算机可读介质例如通过远程信息处理服务器或控制器区域网络(CAN)以分布式方式存储和执行。
本发明提供一种无人机母车和车载无人机,无人机母车和车载无人机搭配使用,车载无人机由无人机母车进行操控;
车载无人机停放在无人机母车中预设位置,预设位置可以为车顶或者车内空间;
无任务执行时,车载无人机停放于无人机母车中预设位置;
无人机母车与车载无人机能够进行实时通信;
车载无人机与无人机母车的组成结构如图1所示。车载无人机包括IMU、GPS、云台控制模块、摄像头,车载无人机主机,其中,IMU、GPS、云台控制模块、摄像头分别与车载无人机主机相连接;摄像头安装于云台上,云台由云台控制模块进行控制,根据摄像头反馈的图像数据计算出来的位姿来实时调整云台,从而调整摄像头的角度;
云台为电动云台,电动云台高速姿态是由两台执行电动机来实现,电动机接受来自控制器的信号精确地运行定位;
在控制信号的作用下,云台上的摄像头既可自动扫描监视区域,也可在无人机母车用户的操纵下跟踪监视对象。
车载无人机还包括WIFI通信模块和或2G/3G/4G/5G通信模块,当近距离时,采用WIFI通信模块;
超出WIFI的传输距离,选择2G/3G/4G/5G通信模块;
车载无人机主机中设置图像处理模块、位姿模块、飞控模块,升降模块;
位姿模块用于计算获取车载无人机的参数,如无人机当前的位置、速度、加速度、俯仰角、横滚角、偏航角等;
飞控模块用于无人机飞行控制;
升降模块用于无人机在起飞和降落过程中的控制;
无人机母车设置T-box,T-box集成了WIFI和2G/3G/4G/5G通信模块通信模块,设置车载以太网的PHY接口;
TSN网关、GPS传感器、IMU传感器、车载主机、显示屏,其中,T-box、车载主机与TSN网关相连接,GPS、IMU与车载主机相连接;显示屏与车载主机相连接;
车载主机设置图像处理模块、位姿模块、无人机控制模块,无人机控制模块用于对无人机进行控制,包括起飞、降落、飞行过程中的控制;
图像处理模块至少用于对无人机拍摄的图片进行处理;
位姿模块至少用于计算当前无人机母车的位置、速度、加速度或者根据来自无人机传送的位置信息计划无人机的位姿参数;
T-box集成WIFI通信和或2G/3G/4G/5G通信或蓝牙通信;
车载无人机与无人机母车涉及安全,车载无人机与无人机母车在使用时需要完成配对。传统的配对方法中,如汽车与智能终端进行互联时,往往通过建立连接较为简单,如采用蓝牙连接时,仅需要输入配对密码即可。但是这种连接方式不安全,比如,如果无人机被拦截,那么其它车辆通过简单的连接方式即可实现与无人机配对,对无人机进行操控。为了解决此问题,本实施例提供一种无人机母车与车载无人机的安全配对方法,参见图2.
用户启动车载无人机配对模式,车载无人机对外发送第一热点;
具体地,车载无人机机身上设置配对按钮或其他方式,通过触摸配对按钮,启动配对模式;第一热点为WIFI热点;
无人机母车对附近热点进行搜索,获取第一热点并输入第一热点的密码;
车载无人机接收到第一热点密码后进行验证,若验证通过,车载无人机向无人机母车请求ID信息;
ID信息至少包括发动机号、无人机母车的车型编号、车载主机的MAC、IP中的一种或多种;
优选的,ID信息包括发动机号、无人机母车的车型编号和车载主机的MAC或IP地址;
为了防止发动机信息被篡改,将发动机号和无人机母车的车型编号写入只读ROM中;
车载无人机收到ID信息后,向验证器请求第一加密信息;
验证器根据ID信息,调用预设的加密算法生成第一加密信息并向无人机母车发送第一加密信息;
无人机母车接收到第一加密信息后,向解密器请求解密;
解密器解密的过程中需要读取车载主机中的存储于只读ROM的中ID信息;
解密器根据第一加密信息调用预置的解密算法生成第一解密信息发送给车载无人机;
车载无人机向验证器请求验证第一解密信息,并反馈验证是否正确的信息给无人机母车;
若正确,则发送同意授权的信息给无人机母车,无人机母车发送车身信息给无人机;
具体地车身信息至少包括无人机母车的停车位置标识信息,如位置的坐标,几何形状、图形以及车身高度,停车位置长度、宽度等信息中的至少一种。
若错误,则中断连接。
为了解决新增的配对无人机母车车型和无人机机型以及新增的无人机母车和无人机,本实施例提供以下解决方案:
验证器、解码器在预设的周期内同步云端服务器,获取更新的内容;
具体地,验证器和解码器还可以放置于云端;
在云端服务器可以设置第一列表和第二列表,第一个列表用于记录允许配对的车型和无人机机型,第二个列表用于记录可配对的车载无人机ID信息和车辆ID信息;
第一个列表的修改限权授权于主机厂;第二个列表的修改权限授权于主机厂指定的授权方;
具体地,由于无人机母车和车载无人机是配对使用的,车载无人机由无人机母车进行操控,发明人在设计时,为了防止业务员的疏忽导致不可控事故发生,采用了两种列表方式,设置第一个列表的修改限权授权于主机厂;第二个列表的修改权限授权于主机厂指定的授权方;
因此只要型号匹配上,则表示无人机母车上设置的操控模块是正确的;设置第二名单在于当出售给用户时,在系统上将无人机ID和无人机母车配对使用,不在名单上的车辆,即使型号符合,也不能配对,更进一步的加强管控;
授权时,验证器首先根据第一列表判断无人机机型和无人机母车车型是否匹配;若匹配,则采用第二列表判断无人机母车ID信息和无人机的ID信息是否在列表中,若匹配,则调用预置算法对解密器提供的验证码进行验证,若成功,则确认授权;
具体地,本实施例提供的技术方案中,无人机与无人机母车配对完成后,无人机母车可以通过车载主机的无人机控制模块对无人机进行控制,如下发起飞和降落的指令,指定目标位置,让无人机飞向目标位置;或给无人机发送目标特征,让无人机自动跟随目标;无人机在飞行过程中,能够将摄像头拍摄的图片实时的传输至无人机母车的车载主机中的显示屏进行显示;
用户可以根据需求,从图像中选择对应的目标,并反馈给无人机,无人机接收到用户指定的目标后,启动目标跟踪,并实时反馈跟踪画面以及目标所在的位置。
本实施例还提供一种无人机的控制方法,如图3所示,具体包括:
用户根据需求,通过无人车母车发送起飞的指令给车载无人机;
车载无人机接收无人机母车的起飞指令;
判断机身当前是否满足起飞条件,若当前机身状态不满足起飞条件,则向无人机母车反馈无法起飞的信息并同时发送故障报告;
若机身满足起飞条件,车载无人机开启起飞模块准备并发送请求起飞的指令给无人机母车;
无人机母车收到请求起飞的信息后,释放车身预设位置固定车载无人机的装置并反馈给车载无人机;
车载无人机完成起飞。
具体地,机身状态信息包括系统通信信号、GPS信号、IMU信号、相机信号以及电池电量;
具体地,本实施例还提供一种无人机的控制方法,如图4所示,具体包括:
S1,用户发送车载无人机降落指令;
S2,无人机接收到降落指令后,调整自身状态,调用升降模块开启降落模式;
S3,获取无人机母车的位姿参数,计算车载无人机与当前无人机母车的距离;
S4,判断当前距离是否能够在捕获无人机母车的预设区间;若否,调整自身飞行参数逐步逼近无人机母车,等待预设的采样周期后,跳转步骤S3;若是,获取无人机母车的标识特征,根据标志特征从捕获的图像中查找无人机母车;
S5,根据标识特征跟踪无人机母车,调整自身飞行参数逐步逼近无人机母车,间隔采样周期获取无人机母车的位姿参数,计算车载无人机与当前无人机母车的距离;
S6,判断当前距离是否能够在捕获无人机母车预设位置的降落标识点;若否,调整自身飞行参数逐步逼近无人机母车,等待预设的采样周期后,跳转步骤S5;若是,获取降落标识点,将降落标识点替换为跟随特征点;
S7,调整自身飞行参数逐步逼近无人机母车,间隔采样周期获取无人机母车的位姿参数,计算车载无人机与当前无人机母车的距离;
S8,判断当前距离是否满足降落距离,若满足,则无人降落到无人机母车的预设位置;
S9,调整自身飞行参数逐步逼近无人机母车,间隔采样周期获取无人机母车的位姿参数,计算车载无人机与当前无人机母车的距离,重复步骤S8。
具体地,摄像头的视野是固定的,因此在低空飞行的时候很容易就丢失掉视野内标识的图像,高空飞行时也容易因为分辨率的问题检测不到地面标识。因此需要考虑改变标识的尺度以及是标识容易被检测到。
为了解决上述问题,本发明相对于现有技术,进行了标识的改进。具体如下:将两种或者多种尺度不同的标识码通过组合固定无人机母车的预设停机区域;
将对无人机母车的颜色进行设置,如将无人机母车的预设位置,如车头或车尾的颜色设置为红色、黄色或其他有利于检测的颜色,并在颜色区域增加大尺度的标识码;标识码用于区分无人机母车与其他相同颜色的车辆。现有行车中,可能存在相同车身的颜色,如果只是按照颜色识别,在无人机母车与其它相同颜色的车辆行驶时,可能会导致无人机追踪错误,通过加上标识码,无人机在识别颜色后,对标识码进行识别,判断是否为与自身配对的无人机母车。
显然,检测车身的颜色相对于特征来说,车身颜色相对简单,计算量小,也容易识别。
具体地,为了方便于无人机在降落时精准快速的降落于无人机母车上,本实施例在降落阶段设置多个距离阈值,在不同的距离阈值区间范围内,无人机追踪不同的标识,使距离阈值与追踪标识搭配使用。
具体地,设计第一标识、第二标识、第三标识,其中,第一标识包括超大尺度的标识和颜色标识,用于在车载无人机与无人机母车的距离d小于第一预设距离d1但大于第二预设距离阈值d2,车载无人机追踪无人机母车的特征标识;
第二标识包括大尺度标识但不包括颜色标识,用于车载无人机与无人机母车的距离小于第二预设距离阈值d2但大于第三预设距离阈值d3时,车载无人机追踪无人机母车的特征标识;
第三标识包括小尺度标识,用于车载无人机与无人机母车的距离小于第三预设距离阈值d3,车载无人机追踪的无人机母车的降落标识;
具体中,第一标识的尺度大于第二标识,第二标识的尺度大于第三标识。
标识图形包括黑白相间的方块组成的图案;或标识二维码或多维码。
优选的,第二标识和第三标识点的中心相同;为了防止两个标识之间的相互串扰,设置第二标识的尺度至少大于5倍于第三标识。
如图5所示,第一标识大于第二标识3倍,设置于车头,第二标识和第三标识设置车身顶部位置,第二标识和第三标识同心设置,标识由黑白相间的方块组成的图案,也可以采用标准的图案库。
如图6所示,第一标识包括大尺度的标志和颜色,在车头和车尾位置设置统一颜色,优选的为红色或绿色或蓝色;在车头位置设置为大尺度的图案标识,图案标识带有无人机母车的编码,通过识别无人机母车的编码,能够区别相同颜色的车与无人机母车;
第二标识和第三标识设置车身顶部位置;第二标识和第三标识同心设置;如图7所示,如图5所示,第一标识大于第二标识至少3倍,设置于车头,第二标识和第三标识设置车身顶部位置,第二标识的图形尺度大于第三标识至少10倍,其中,第三标识采用奇数个视觉标记,一个位于着陆点的末端或首端,其余偶数点组成长方形,着陆点的末端或首端点与长方形的顶点构成三角形,用于定位无人机停车位置。例如:第三标识采用5个视觉标记,其中4个组成一个正方形,一个位于着陆点的末端,与正方形中的其他两个目标一起构成一个等边三角形,用于定位无人机停车位置。根据具体情况,也可以采用偶数个点。
申请人在研究发现,可以通过使用更大的大标识轻松扩展上限,但较低的范围对于无人机精准自主降落在无人机母车的预设位置非常重要,第三标识检测意味着最小可检测的相对高度;
在自主降落时,无人机升降控制模块关闭发动机,然后自由落体,并希望在达到最小可检测相对高度时成功着陆;在垂直着陆过程中,长时间自由落体的风险很高,由于受到周围环境的影响,如风等。另外,无人机母车可能此时正处于运动中,也会加剧自由落体的风险。
为了解决此问题,本实施例在进行标识和距离范围时,使用不同的控制策略,具体如下:
本实施例中,如图7至图9所示,具体地,设计第一预设距离阈值,如1~2公里范围内,设车载无人机和无人机母车的距离为d;
当d大于第一阈值d1是,不启动无人机母车捕捉;
此时,由于无人机距离较远,相机视野范围受到限制,无法获取无人机母车的图像,故在此范围内并不进行图像识别,可以关闭相机拍摄功能;
无人机采用PID自动控制中P控制,反馈量采用距离d、无人机的当前运行速度V1和无人机母车的运行速度V2,此时,根据当前速度选择是否提升P控制增益Kp。
当d小于第一预设距离阈值d1但大于第二预设距离阈值d2时,开启相机获取图像,根据预设的第一特征信息在图像中捕获无人机母车的第一标识;
无人机采用PID自动控制中PD控制,反馈量采用d、无人机的当前运行速度V1和无人机母车的运行速度V2;
此时,P控制增益Kp降低。
当d小于第二预设距离阈值d2但大于第三预设距离阈值d3时,切换为第二特征信息,根据切换的特征信息在图像中捕获无人机母车的第二标识;
采用无人机采用PID自动控制中PD控制,反馈量采用d、无人机的当前运行速度V1和无人机母车的运行速度V2;
当d小于第三预设距离阈值d3但大于第四预设距离阈值d4时,切换为第三特征信息,根据切换的第三特征信息在图像中捕获无人机母车的第三标识;
采用无人机采用PID自动控制中PD控制,反馈量采用d、无人机的当前运行速度V1和无人机母车的运行速度V2。
具体地,由于无人机母车与车载无人机可能都处于运动阶段,这相比现有技术中,无人机降落在停机坪或者固定的地点不同,由于是相对运行,无人机母车和车载无人机的位置都在发生变化,如何使得无人机快速追踪到无人机母车就显得非常重要,本实施例提供了以下控制策略:
通过卡尔曼滤波,预测无人机母车和车载无人机各自的位置、速度、加速度,将位置、速度、加速度输入控制器,生成控制信号输入给车载无人机升降控制模块控制车载无人机;
在车载无人机和无人机母车的之间的距离d小于第一预设距离阈值d1,卡尔曼滤波的预测的输入依赖于车载无人机和无人机母车的GPS和IMU,采样频率以GPS的更新频率;
在车载无人机和无人机母车的之间的距离d小于第一预设距离阈值d1,d大于第三预设距离阈值d3,卡尔曼滤波的预测的输入依赖于相机的位姿参数和无人机母车的速度,采样频率以位姿参数更新的频率;
在车载无人机和无人机母车的之间的距离d小于第三预设距离阈值d3,卡尔曼滤波的预测的输入依赖于相机的位姿参数和无人机母车的速度以及IMU计算出的水平方向和垂直方向加速度,采样频率以位姿参数更新的频率;
由于降落阶段,需要更准确的数据,通过无人机母车的IMU提供加速度,精确预测关闭飞机动力系统的时机。
现有车载无人机在降落阶段,由于无人机母车可能是在运动的。由于地面环境较为复杂,可能导致无人机在跟踪无人机母车的过程中遇见隧道、树木、房屋等阻挡而导致目标丢失。但现有技术中并未提供解决方案,本实施例提供一种新的解决方法,在车载无人机跟踪无人机母车的标识特征还包括对标识特征的判断和更新,具体至少包括:
步骤B1,通过车载无人机的相机采集图像,对采集的图像进行图像预处理;
步骤B2,根据给定的特征标识从图像中提取跟踪目标;
步骤B3,调用已存储目标的信息帧对跟踪目标进行判断是否需要矫正;
步骤B4,若需要矫正,对图像重新进行预处理,跳转步骤B2;
若无需矫正,将提取跟踪目标的图像特征反馈给跟踪算法进行跟踪;
步骤B5,将跟踪算法获取的目标的帧信息进行存储并更新目标的帧信息。
以上所述的仅是本发明的优选实施方式,本发明不限于以上实施例。本领域的技术人员可以清楚,该实施例中的形式不局限于此,同时可调整方式也不局限于此。可以理解,本领域技术人员在不脱离本发明的基本构思的前提下直接导出或联想到的其他改进和变化,均应认为包含在本发明的保护范围之内。
Claims (13)
1.一种基于无人机母车的车载无人机的升降方法,其特征在于,至少包括:
用户根据需求,通过无人机母车发送起飞或降落的指令给车载无人机;
车载无人机对接收的指令进行解析并根据指令执行采用相应的措施并反馈执行的信息给无人机母车;
无人机母车根据车载无人机反馈执行的信息采取对应的措施配合车载无人机进行起飞或降落;
车载无人机接收到降落指令后,调整自身状态,调用升降模块开启降落模式;
获取无人机母车的位姿参数,计算车载无人机与无人机母车的当前距离d;
将当前距离d与预设的距离阈值相比,执行预设的标识跟踪和控制策略,实现精准降落;
当前距离d大于第一预设距离阈值d1,则不满足捕获无人机母车的预设区间;
当前距离d小于第一预设距离阈值d1但大于第二预设距离阈值d2,满足捕获无人机母车的预设区间,标识特征为第一标识特征,第一标识包括超大尺度的标识和颜色标识。
2.如权利要求1所述一种基于无人机母车的车载无人机的升降方法,其特征在于,判断当前距离d是否能够在捕获无人机母车的预设区间;若否,调整自身飞行参数逐步逼近无人机母车,等待预设的采样周期后,重新计算当前距离d,直至当前距离满足捕获无人机母车的预设期间;
若是,获取无人机母车的标识特征,根据标识特征从捕获的图像中查找无人机母车,根据标识特征跟踪无人机母车。
3.如权利要求1所述一种基于无人机母车的车载无人机的升降方法,其特征在于,当前距离d小于第二预设距离阈值d2但大于第三预设距离阈值d3,满足捕获无人机母车的预设区间,标识特征为第二标识特征,第二标识包括大尺度标识但不包括颜色标识,第二标识特征的尺度小于第一标识特征。
4.如权利要求1所述一种基于无人机母车的车载无人机的升降方法,其特征在于,调整自身飞行参数逐步逼近无人机母车,间隔采样周期获取无人机母车的位姿参数,计算车载无人机与无人机母车的当前距离d;
判断当前距离d是否能够在捕获无人机母车预设位置的降落标识点;
若否,调整自身飞行参数逐步逼近无人机母车,等待预设的采样周期后,重复当前距离计算与判断直至当前距离d满足捕获降落标识点;
若是,获取降落标识点,将降落标识点替换为跟随特征点;
其中,当前距离d小于第三预设距离阈值d3,则满足捕获无人机母车的预设位置降落标识点,降落标识点包括第三标识点。
5.如权利要求1所述一种基于无人机母车的车载无人机的升降方法,其特征在于,调整自身飞行参数逐步逼近无人机母车,计算车载无人机与当前无人机母车的距离,判断当前距离是否满足降落距离;
若否,根据相机捕获第三标识点计算的位置参数以及无人机母车的速度和加速度调整自身飞行参数逐步逼近无人机母车,间隔采样周期获取相机的位姿参数,计算车载无人机与当前无人机母车的距离,重复当前距离计算与判断直至当前距离d满足降落距离;
若满足,则无人机降落到无人机母车的预设位置。
6.一种基于无人机母车的车载无人机的升降方法,其特征在于,当无人机母车发送降落指令给无人机时,车载无人机接收到降落指令后,开启降落模式;
在车载无人机降落阶段设置多个距离阈值和与距离阈值对应的捕获特征标识,计算无人机母车与车载无人机的当前距离d,将当前距离d与预设的多个距离阈值进行对比,根据比较结果使无人机追踪对应的特征标识;
所述多个距离阈值至少包括第一预设距离阈值d1、第二预设距离阈值d2、第三预设距离阈值d3;特征标识包括第一标识、第二标识、第三标识;
第一标识包括超大尺度的标识和颜色标识,用于在车载无人机与无人机母车的距离d小于第一预设距离d1但大于第二预设距离阈值d2时,车载无人机追踪无人机母车的特征标识。
7.如权利要求6所述一种基于无人机母车的车载无人机的升降方法,其特征在于,其中,第一标识的尺度大于第二标识尺度,第二标识的尺度大于所述第三标识的尺度,第一标识还包括颜色标识。
8.如权利要求6所述一种基于无人机母车的车载无人机的升降方法,其特征在于,
第二标识包括大尺度标识但不包括颜色标识,用于车载无人机与无人机母车的距离小于第二预设距离阈值d2但大于第三预设距离阈值d3时,车载无人机追踪无人机母车的特征标识;
第三标识包括小尺度标识,用于车载无人机与无人机母车的距离小于第三预设距离阈值d3,车载无人机追踪的无人机母车的降落标识。
9.如权利要求6所述的一种基于无人机母车的车载无人机的升降方法,其特征在于,特征标识图形至少包括黑白相间的方块组成的图案或标识二维码或多维码或预设特征图案。
10.如权利要求6或7所述一种基于无人机母车的车载无人机的升降方法,其特征在于,其中,第二标识和第三标识点的中心相同;设置第二标识的尺度至少大于5倍于第三标识。
11.如权利要求1或6所述一种基于无人机母车的车载无人机的升降方法,其特征在于,若当前距离d大于第一阈值d1时,车载无人机采用比例P控制,反馈量采用当前距离d、车载无人机的当前运行速度V1和无人机母车的运行速度V2输入控制器,根据当前速度选择是否提升P控制增益Kp;
或若当前距离d小于等于第一预设距离阈值d1时,车载无人机采用PD控制,反馈量采用当前距离d、无人机的当前运行速度V1和无人机母车的运行速度V2,降低P控制增益Kp。
12.如权利要求1或6所述一种基于无人机母车的车载无人机的升降方法,其特征在于,通过卡尔曼滤波,预测无人机母车和车载无人机各自的位置、速度、加速度,将位置、速度、加速度输入控制器,生成控制信号输入给车载无人机升降控制模块控制车载无人机。
13.如权利要求12所述一种基于无人机母车的车载无人机的升降方法,其特征在于,在车载无人机和无人机母车之间的当前距离d小于第一预设距离阈值d1,卡尔曼滤波的预测的输入依赖于车载无人机和无人机母车的GPS和IMU,采样频率同步GPS的更新频率;
在车载无人机和无人机母车之间的距离d小于第一预设距离阈值d1,d大于第二预设距离阈值d2,卡尔曼滤波的预测的输入依赖于相机的位姿参数和无人机母车的速度,采样频率同步于位姿参数更新的频率;
在车载无人机和无人机母车的之间的距离d小于第三预设距离阈值d3,卡尔曼滤波的预测的输入依赖于相机的位姿参数和无人机母车的速度以及IMU计算出的水平方向和垂直方向加速度,采样频率同步位姿参数更新的频率。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210029853.2A CN114384921B (zh) | 2022-01-12 | 2022-01-12 | 一种基于无人机母车的车载无人机的升降方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210029853.2A CN114384921B (zh) | 2022-01-12 | 2022-01-12 | 一种基于无人机母车的车载无人机的升降方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114384921A CN114384921A (zh) | 2022-04-22 |
CN114384921B true CN114384921B (zh) | 2024-05-28 |
Family
ID=81202790
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210029853.2A Active CN114384921B (zh) | 2022-01-12 | 2022-01-12 | 一种基于无人机母车的车载无人机的升降方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114384921B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116700307A (zh) * | 2023-06-12 | 2023-09-05 | 清华大学 | 车辆高速运动条件下的车载三自由度无人机起降系统 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105512628A (zh) * | 2015-12-07 | 2016-04-20 | 北京航空航天大学 | 基于无人机的车辆环境感知系统及方法 |
CN107065924A (zh) * | 2017-03-15 | 2017-08-18 | 普宙飞行器科技(深圳)有限公司 | 无人机车载起降系统、可车载起降无人机及降落方法 |
CN107544550A (zh) * | 2016-06-24 | 2018-01-05 | 西安电子科技大学 | 一种基于视觉引导的无人机自动着陆方法 |
CN207328853U (zh) * | 2017-06-27 | 2018-05-08 | 歌尔科技有限公司 | 一种起降平台 |
CN109298723A (zh) * | 2018-11-30 | 2019-02-01 | 山东大学 | 一种车载无人机精准降落方法和系统 |
CN110989661A (zh) * | 2019-11-19 | 2020-04-10 | 山东大学 | 一种基于多个定位二维码的无人机精准降落方法及系统 |
CN111338363A (zh) * | 2018-12-18 | 2020-06-26 | 深圳市贝贝特科技实业有限公司 | 一种无人机车载降落方法及系统 |
CN111813148A (zh) * | 2020-07-22 | 2020-10-23 | 广东工业大学 | 一种无人机降落方法、系统、设备和存储介质 |
CN111930146A (zh) * | 2020-08-25 | 2020-11-13 | 上海比茵沃汽车电子有限公司 | 一种车载无人机精准降落识别方法 |
CN112706937A (zh) * | 2020-04-08 | 2021-04-27 | 江苏方天电力技术有限公司 | 无人机柔性精准自主起降装置及控制方法 |
CN112907574A (zh) * | 2021-03-25 | 2021-06-04 | 成都纵横自动化技术股份有限公司 | 一种飞行器的降落点寻找方法、装置、系统及存储介质 |
CN113495569A (zh) * | 2021-06-17 | 2021-10-12 | 上海大风技术有限公司 | 一种基于自主识别的无人机精准降落方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019182521A1 (en) * | 2018-03-22 | 2019-09-26 | Infinium Robotics Pte Ltd | Autonomous taking off, positioning and landing of unmanned aerial vehicles (uav) on a mobile platform |
-
2022
- 2022-01-12 CN CN202210029853.2A patent/CN114384921B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105512628A (zh) * | 2015-12-07 | 2016-04-20 | 北京航空航天大学 | 基于无人机的车辆环境感知系统及方法 |
CN107544550A (zh) * | 2016-06-24 | 2018-01-05 | 西安电子科技大学 | 一种基于视觉引导的无人机自动着陆方法 |
CN107065924A (zh) * | 2017-03-15 | 2017-08-18 | 普宙飞行器科技(深圳)有限公司 | 无人机车载起降系统、可车载起降无人机及降落方法 |
CN207328853U (zh) * | 2017-06-27 | 2018-05-08 | 歌尔科技有限公司 | 一种起降平台 |
CN109298723A (zh) * | 2018-11-30 | 2019-02-01 | 山东大学 | 一种车载无人机精准降落方法和系统 |
CN111338363A (zh) * | 2018-12-18 | 2020-06-26 | 深圳市贝贝特科技实业有限公司 | 一种无人机车载降落方法及系统 |
CN110989661A (zh) * | 2019-11-19 | 2020-04-10 | 山东大学 | 一种基于多个定位二维码的无人机精准降落方法及系统 |
CN112706937A (zh) * | 2020-04-08 | 2021-04-27 | 江苏方天电力技术有限公司 | 无人机柔性精准自主起降装置及控制方法 |
CN111813148A (zh) * | 2020-07-22 | 2020-10-23 | 广东工业大学 | 一种无人机降落方法、系统、设备和存储介质 |
CN111930146A (zh) * | 2020-08-25 | 2020-11-13 | 上海比茵沃汽车电子有限公司 | 一种车载无人机精准降落识别方法 |
CN112907574A (zh) * | 2021-03-25 | 2021-06-04 | 成都纵横自动化技术股份有限公司 | 一种飞行器的降落点寻找方法、装置、系统及存储介质 |
CN113495569A (zh) * | 2021-06-17 | 2021-10-12 | 上海大风技术有限公司 | 一种基于自主识别的无人机精准降落方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114384921A (zh) | 2022-04-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104298248B (zh) | 旋翼无人机精确视觉定位定向方法 | |
CN108132678B (zh) | 一种飞行器的飞行控制方法及相关装置 | |
CN103592948B (zh) | 无人机飞行防撞方法 | |
CN107943073A (zh) | 无人机起降方法、设备、系统及无人机 | |
CN104932525A (zh) | 无人机的控制方法、装置、地面控制系统及无人机 | |
CN107544531B (zh) | 线路巡检方法、装置及无人机 | |
KR101701397B1 (ko) | 무인 비행체를 이용한 차량 단속방법 및 시스템 | |
CN112558608A (zh) | 一种基于无人机辅助的车机协同控制及路径优化方法 | |
US10157545B1 (en) | Flight navigation using lenticular array | |
WO2016201359A1 (en) | A low altitude aircraft identification system | |
CN111506091A (zh) | 基于动态二维码的无人机精准降落控制系统及方法 | |
CN111627256A (zh) | 无人机控制方法、车载终端及计算机可读存储介质 | |
CN106647785B (zh) | 无人机停机坪控制方法及装置 | |
CN106502257A (zh) | 一种无人机精准降落抗干扰的控制方法 | |
CN111465556B (zh) | 信息处理系统、信息处理方法及电脑可读存储媒体 | |
CN113093772A (zh) | 一种无人机机库精确降落方法 | |
CN113568427B (zh) | 无人机自主着陆移动平台的方法及系统 | |
CN114384921B (zh) | 一种基于无人机母车的车载无人机的升降方法 | |
JP2020138681A (ja) | 無人飛行体の制御システム | |
CN114967731A (zh) | 一种基于无人机的野外人员自动搜寻方法 | |
CN111079525B (zh) | 图像处理方法、设备、系统及存储介质 | |
US20240274007A1 (en) | Vehicle Control Method, Vehicle, and Server | |
CN111247792B (zh) | 一种无人机的控制方法、无人机及计算机可读存储介质 | |
CN113359724B (zh) | 基于无人机的车辆智能驾驶系统、方法及存储介质 | |
Lee et al. | A mission management system for complex aerial logistics by multiple unmanned aerial vehicles in MBZIRC 2017 |
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 |