CN114355982A - 无人机自动增程巡航***的无人机自动着陆方法及装置 - Google Patents
无人机自动增程巡航***的无人机自动着陆方法及装置 Download PDFInfo
- Publication number
- CN114355982A CN114355982A CN202210077725.5A CN202210077725A CN114355982A CN 114355982 A CN114355982 A CN 114355982A CN 202210077725 A CN202210077725 A CN 202210077725A CN 114355982 A CN114355982 A CN 114355982A
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- deviation
- landing
- positioning
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 24
- 238000012937 correction Methods 0.000 claims abstract description 27
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 13
- 230000000007 visual effect Effects 0.000 claims description 33
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 238000001914 filtration Methods 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 6
- 238000002360 preparation method Methods 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 5
- 238000007689 inspection Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 239000003550 marker Substances 0.000 description 2
- 230000002265 prevention Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000010008 shearing Methods 0.000 description 1
- 239000000779 smoke Substances 0.000 description 1
Images
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及无人机巡航领域,提供了一种无人机自动增程巡航***的无人机自动着陆方法及装置。目的在于解决现有情况下机库需发送高精度的RTK差分GPS信号进行无人机精确引导的限制问题。主要方案包括根据机身GPS接收机的位置信息和降落点的坐标信息,计算降落点的位置偏差,向机身飞控***发送位置修正指令消息,控制机身进行大尺度的位置偏差修正;当机身到达预定降落的GPS位置坐标后,启动机身定标摄像头,识别定位标记,然后启动小尺度位置偏移计算,通过定位标记在定标摄像头画面中得到的位置计算机身到定位标记的小尺度位置偏移,调整机身位置保持无人机与定位标记在误差允许的坐标范围内,从而实现无人机准确的降落在定位坐标中心。
Description
技术领域
本发明涉及无人机巡航领域,提供了一种无人机自动增程巡航***的无人机自动着陆方法及装置。
背景技术
针对处于人烟稀少、位置偏僻、环境恶劣的地区,防灾减灾、搜索营救、交通监管、资源勘探、国土资源监测、边防巡逻、森林防火、气象探测、农作物估产、管道巡检等领域需要人工巡检操作,传统人工巡检方式存在效率低、覆盖面不全以及安全等弊端,随着现代化科学技术的不断进步以及企业安全意识的逐步提高,对智能化***的要求也越来越迫切。近年来,无人机巡检技术飞速发展,特别是电动多旋翼无人机,由于机身成本低、使用方便,已经在许多领域逐步得以推广使用,通过借助无人机,在无人机上安装摄像机、激光雷达等,实现关键位置无人机巡检,大大减少人力成本,也为极端环境下的巡检工作带来可能。
目前还没有专门用于偏远地区的无人机自动增程巡航***装置。
现有技术的缺陷
针对这些缺点,说明本发明的目的以及能够解决什么技术问题。
虽然多旋翼电动无人机具有明显的行业应用优势,但是由于其主要靠电池提供动力,续航里程往往有限,因此在日常应用中任然需要工作人员现场操作无人机,或者在其有限续航范围内进行作业,以便在无人机电池电力消耗完时及时收回无人机对其进行充电和更换电池,补充动力。给其在行业应用中的推广带来诸多限制,主要体现在如下几个方面:首先跟随式巡检造成人员在在巡检线路中的安全隐患,无论是驱车还是步行,对于一些地势复杂的巡检线路增加了跟随人员的工作强度,降低了无人机巡检作业的效率。其次,人员操作具有较大的误操作和发现处理不及时因素,容易导致无人机因回收不及时造成不能按照预计位置进行回收,导致因动力耗尽而坠机的风险,从而增加了无人机在巡检作业的应用门槛和工作强度。
目前多旋翼无人机降落位置引导主要通过基于差分GPS信号的RTK技术进行精确定位,由于RTK技术是有源定位,需要通过预先架设的RTK基站发射差分GPS定位信息,无人机通过机身接收机进行解算后方能精确获得自己的准确位置信息。相比于卫星GPS信号,由于RTK基站一般部署于地面,受周围地势环境和发射功率影响,往往限制了定位信号的覆盖范围,因此无人机通过RTK进行精确定位的便利性受到限制。
发明内容
本发明的目的在于解决现有情况下机库需发送高精度的RTK差分GPS信号进行无人机精确引导的限制问题。
为了实现上述目的本发明采用以下技术方案:
一种无人机自动增程巡航***的无人机自动着陆方法,包括控制站、无人机、固定式自动机库,无人机通过GPS及视觉引导联合定位方法完成无人机降落,
GPS及视觉引导联合定位装置实现步骤如下:
步骤1、首先根据机身GPS接收机的位置信息和降落点的坐标信息,计算降落点的位置偏差,向机身飞控***发送位置修正指令消息,控制机身进行大尺度的位置偏差修正;
步骤2、当机身到达预定降落的GPS位置坐标后,向机身飞控***发送降落准备指令,将机身高度控制在要求的降落高度上;
步骤3、启动机身定标摄像头,识别用于降落的定位标记,然后启动小尺度位置偏移计算,通过定位标记在定标摄像头画面中得到的位置计算机身到定位标记的小尺度位置偏移,根据小尺度位置偏移调整机身位置保持无人机与定位标记在误差允许的坐标范围内,从而实现无人机准确的降落在定位坐标中心。
上述技术方案中,步骤1中控制机身进行大尺度的位置偏差修正,包括如下步骤:
无人机计算处理器根据预算的降落点坐标和机身GPS接收机定位坐标进行大尺度偏差控制,经过实时滤波后得到稳定的偏差值,判断当前偏差值是否满足大尺度定位门限,当大于大尺度定位门限时将该偏差值发送给机身飞行控制器,由飞行控制器控制无人机向预设的降落点GPS位置移动;当偏差值小于门限时结束大尺度偏差控制,进入小尺度偏差控制。
上述技术方案中,小尺度偏差控制:
δ(x,y)=-g(H,(α,β)),α=arctan(xc,f),β=arctan(yc,f),γ=arctan((y′c2-y′c1)/(x′c2-x′c1)),其中f为定标摄像机焦距,(xc,yc)为像素偏离距离,无人机身的水平偏移位置δ(x,y)是计算得到的无人机在水平方向上的位移偏差,α是标定摄像机到降落定位二维码中心点沿X轴方向偏离的垂直角度估计,xc是根据定位标记在定标摄像机水平画面中心位置沿X轴方向的偏移像素距离,yc是根据定位标记在定标摄像机水平画面中心位置沿Y轴方向的偏移像素距离,β是标定摄像机到降落定位二维码中心点沿Y轴方向偏离的垂直角度估计,即(α,β)为无人机机身到定位标记的视觉夹角,其大小由中心点在定标摄像机画面中的像素位置和焦距共同作用,y是机身机头朝向在水平方向上与标记点正向上的水平角度估计即机身水平偏离角度,其大小由定标摄像机画面中的定位标记轮廓指定的一边与画面坐标轴之间的夹角确定,x′c1,x′c2,y′c1,y′c2分别是定位标记轮廓中指定的一边两个端点在定标摄像机画面中的水平和垂直边的投影距离,g(H,(α,β))是最终由机身高度与垂直偏离角所确定的函数,H是机身相对降落点的高度测量值即无人机机身高度。
上述技术方案中,像素偏离距离计算:
根据定标摄像头的画面解析度计算定位标记中心点距离画面中心原点的位置即像素偏离距离(xc,yc),其中xc=x′c-Xc/2,yc=y′c-Yc/2,(Xc,Yc)为定标摄像头的画面像素解析度尺寸,其中(x′c,y′c)为定位标记中心点坐标;
根据得到的像素偏离距离(xc,yc)和定标摄像头的焦距参数,可以通过三角函数正切变换进一步得到无人机机身到定位标记的视觉夹角(α,β)。
一种无人机自动增程巡航***的无人机自动着陆装置,包括控制站、无人机、固定式自动机库,无人机通过GPS及视觉引导联合定位模块完成无人机降落,
GPS及视觉引导联合定位模块包括:
大尺度修正模块、首先根据机身GPS接收机的位置信息和降落点的坐标信息,计算降落点的位置偏差,向机身飞控***发送位置修正指令消息,控制机身进行大尺度的位置偏差修正,当机身到达预定降落的GPS位置坐标后,向机身飞控***发送降落准备指令,将机身高度控制在要求的降落高度上;
小尺度修正模块、启动机身定标摄像头,识别用于降落的定位标记,然后启动小尺度位置偏移计算,通过定位标记在定标摄像头画面中得到的位置计算机身到定位标记的小尺度位置偏移,根据小尺度位置偏移调整机身位置保持无人机与定位标记在误差允许的坐标范围内,从而实现无人机准确的降落在定位坐标中心。
上述技术方案中,大尺度修正模块:
无人机计算处理器根据预算的降落点坐标和机身GPS接收机定位坐标进行大尺度偏差控制,经过实时滤波后得到稳定的偏差值,判断当前偏差值是否满足大尺度定位门限,当大于大尺度定位门限时将该偏差值发送给机身飞行控制器,由飞行控制器控制无人机向预设的降落点GPS位置移动;当偏差值小于门限时结束大尺度偏差控制,进入小尺度偏差控制。
上述技术方案中,小尺度偏差控制:
δ(x,y)=-g(H,(α,β)),α=arctan(xc,f),β=arctan(yc,f),γ=arctan((y′c2-y′c1)/(x′c2-x′c1)),其中f为定标摄像机焦距,(xc,yc)为像素偏离距离,无人机身的水平偏移位置δ(x,y)是计算得到的无人机在水平方向上的位移偏差,α是标定摄像机到降落定位二维码中心点沿X轴方向偏离的垂直角度估计,xc是根据定位标记在定标摄像机水平画面中心位置沿X轴方向的偏移像素距离,yc是根据定位标记在定标摄像机水平画面中心位置沿Y轴方向的偏移像素距离,β是标定摄像机到降落定位二维码中心点沿Y轴方向偏离的垂直角度估计,即(α,β)为无人机机身到定位标记的视觉夹角,其大小由中心点在定标摄像机画面中的像素位置和焦距共同作用,γ是机身机头朝向在水平方向上与标记点正向上的水平角度估计即机身水平偏离角度,其大小由定标摄像机画面中的定位标记轮廓指定的一边与画面坐标轴之间的夹角确定,x′c1,x′c2,y′c1,y′c2分别是定位标记轮廓中指定的一边两个端点在定标摄像机画面中的水平和垂直边的投影距离,g(H,(α,β))是最终由机身高度与垂直偏离角所确定的函数,H是机身相对降落点的高度测量值即无人机机身高度。
上述技术方案中,像素偏离距离计算:
根据定标摄像头的画面解析度计算定位标记中心点距离画面中心原点的位置即像素偏离距离(xc,yc),其中xc=x′c-Xc/2,yc=y′c-Yc/2,(Xc,Yc)为定标摄像头的画面像素解析度尺寸,其中(x′c,y′c)为定位标记中心点坐标;
根据得到的像素偏离距离(xc,yc)和定标摄像头的焦距参数,可以通过三角函数正切变换进一步得到无人机机身到定位标记的视觉夹角(α,β)。
因为本发明采用上述技术方案,因此具备以下有益效果:
①
本发明提供了的技术方案实现自主降落控制。通过本发明的卫星GPS+视觉引导降落方法实现无人机自主精准降落,卫星GPS信号覆盖范围广,视觉引导由无人机自主发起,只需地面机库灵活的通过定位标记即可引导无人机进行精准的降落,从而避免了现有情况下机库需发送高精度的RTK差分GPS信号进行无人机精确引导的限制,增强了因地形和人为情况下的GPS信号干扰带来的定位误差的问题,提升了无人机降落的灵活性和便利性。
综上,本发明装置及方法不仅克服了传统无人机巡检方式的弊端,降低了无人机巡检作业的人工操作强度,提升了无人机巡检作业的工作效率,扩展了巡检作业的范围。
附图说明
图1为本发明流程简图;
图2为大尺度偏差控制流程简图;
图3为机身与定位标记在三维投影中的偏差参数示意图;
图4为小尺度偏差控制流程简图;
图5为定位标记在定标摄像机画面中心点的像素偏移距离;
图6为机身水平偏离距离计算示意图;
图7为水平偏移角度校正示意图;
图8为机身水平偏离角度计算示意图。
具体实施方式
以下将对本发明的实施例给出详细的说明。尽管本发明将结合一些具体实施方式进行阐述和说明,但需要注意的是本发明并不仅仅只局限于这些实施方式。相反,对本发明进行的修改或者等同替换,均应涵盖在本发明的权利要求范围当中。
另外,为了更好的说明本发明,在下文的具体实施方式中给出了众多的具体细节。本领域技术人员将理解,没有这些具体细节,本发明同样可以实施。
本发明通过一种无人机自动增程巡航***装置,包括控制站、无人机、固定式自动机库,实现多旋翼电动无人机在不同机库之间的自动起降,实现无人机在巡检作业中的自动停靠充电,变单次巡航为连续充电巡航,从而解决了无人机在长距离巡航过程中需人力跟随的局限,增强了无人机大范围巡检作业的自动化水平,降低了无人机巡检过程中的人工劳动强度和作业危险系数。
GPS+视觉引导精准降落方法
通过卫星GPS和视觉引导对无人机降落过程进行精确定位,首先利用机身卫星GPS接收机得到的机身位置坐标与降落点的GPS位置坐标进行大尺度位置偏移的计算,使无人机上搭载的定标摄像头捕获到降落点的定位标记,然后启动小尺度位置偏移计算,通过定位标记在定标摄像头中的位置计算机身到定位标记的小尺度位置偏移,调整机身位置保持无人机与定位标记在误差允许的坐标范围内,从而实现无人机准确的降落在定位坐标中心。
在此基础上本发明提供了一种无人机自动增程巡航***的无人机自动着陆方法,包括控制站、无人机、固定式自动机库,无人机通过GPS及视觉引导联合定位方法完成无人机降落,
参见图1,GPS及视觉引导联合定位装置实现步骤如下:
步骤1、首先根据机身GPS接收机的位置信息和降落点的坐标信息,计算降落点的位置偏差,向机身飞控***发送位置修正指令消息,控制机身进行大尺度的位置偏差修正;
步骤2、当机身到达预定降落的GPS位置坐标后,向机身飞控***发送降落准备指令,将机身高度控制在要求的降落高度上;
步骤3、启动机身定标摄像头,识别用于降落的定位标记,然后启动小尺度位置偏移计算,通过定位标记在定标摄像头画面中得到的位置计算机身到定位标记的小尺度位置偏移,根据小尺度位置偏移调整机身位置保持无人机与定位标记在误差允许的坐标范围内,从而实现无人机准确的降落在定位坐标中心。
上述技术方案中,参见图2,步骤1中控制机身进行大尺度的位置偏差修正,包括如下步骤:
无人机计算处理器根据预算的降落点坐标和机身GPS接收机定位坐标进行大尺度偏差控制,经过实时滤波后得到稳定的偏差值,判断当前偏差值是否满足大尺度定位门限,当大于大尺度定位门限时将该偏差值发送给机身飞行控制器,由飞行控制器控制无人机向预设的降落点GPS位置移动;当偏差值小于门限时结束大尺度偏差控制,进入小尺度偏差控制。
上述技术方案中,小尺度偏差控制:
δ(x,y)=-g(H,(α,β)),α=arctan(xc,f),β=arctan(yc,f),γ=arctan((y′c2-y′c1)/(x′c2-x′c1)),其中f为定标摄像机焦距,(xc,yc)为像素偏离距离,参见图6,无人机身的水平偏移位置δ(x,y)是计算得到的无人机在水平方向上的位移偏差,α是标定摄像机到降落定位二维码中心点沿X轴方向偏离的垂直角度估计,xc是根据定位标记在定标摄像机水平画面中心位置沿X轴方向的偏移像素距离,yc是根据定位标记在定标摄像机水平画面中心位置沿Y轴方向的偏移像素距离,β是标定摄像机到降落定位二维码中心点沿Y轴方向偏离的垂直角度估计,即(α,β)为无人机机身到定位标记的视觉夹角,其大小由中心点在定标摄像机画面中的像素位置和焦距共同作用,参见图7、图8,γ是机身机头朝向在水平方向上与标记点正向上的水平角度估计即机身水平偏离角度,其大小由定标摄像机画面中的定位标记轮廓指定的一边与画面坐标轴之间的夹角确定,x′c1,x′c2,y′c1,y′c2分别是定位标记轮廓中指定的一边两个端点在定标摄像机画面中的水平和垂直边的投影距离,g(H,(α,β))是最终由机身高度与垂直偏离角所确定的函数,H是机身相对降落点的高度测量值即无人机机身高度。
上述技术方案中,像素偏离距离计算:
参见图5,根据定标摄像头的画面解析度计算定位标记中心点距离画面中心原点的位置即像素偏离距离(xc,yc),其中xc=x′c-Xc/2,yc=y′c-Yc/2,(Xc,Yc)为定标摄像头的画面像素解析度尺寸,其中(x′c,y′c)为定位标记中心点坐标;
根据得到的像素偏离距离(xc,yc)和定标摄像头的焦距参数,可以通过三角函数正切变换进一步得到无人机机身到定位标记的视觉夹角(α,β)。
一种无人机自动增程巡航***的无人机自动着陆装置,包括控制站、无人机、固定式自动机库,无人机通过GPS及视觉引导联合定位模块完成无人机降落,
GPS及视觉引导联合定位模块包括:
大尺度修正模块、首先根据机身GPS接收机的位置信息和降落点的坐标信息,计算降落点的位置偏差,向机身飞控***发送位置修正指令消息,控制机身进行大尺度的位置偏差修正,当机身到达预定降落的GPS位置坐标后,向机身飞控***发送降落准备指令,将机身高度控制在要求的降落高度上;
小尺度修正模块、启动机身定标摄像头,识别用于降落的定位标记,然后启动小尺度位置偏移计算,通过定位标记在定标摄像头画面中得到的位置计算机身到定位标记的小尺度位置偏移,根据小尺度位置偏移调整机身位置保持无人机与定位标记在误差允许的坐标范围内,从而实现无人机准确的降落在定位坐标中心。
上述技术方案中,大尺度修正模块:
无人机计算处理器根据预算的降落点坐标和机身GPS接收机定位坐标进行大尺度偏差控制,经过实时滤波后得到稳定的偏差值,判断当前偏差值是否满足大尺度定位门限,当大于大尺度定位门限时将该偏差值发送给机身飞行控制器,由飞行控制器控制无人机向预设的降落点GPS位置移动;当偏差值小于门限时结束大尺度偏差控制,进入小尺度偏差控制。
上述技术方案中,小尺度偏差控制:
δ(x,y)=-g(H,(α,β)),α=arctan(xc,f),β=arctan(yc,f),γ=arctan((y′c2-y′c1)/(x′c2-x′c1)),其中f为定标摄像机焦距,(xc,yc)为像素偏离距离,无人机身的水平偏移位置δ(x,y)是计算得到的无人机在水平方向上的位移偏差,α是标定摄像机到降落定位二维码中心点沿X轴方向偏离的垂直角度估计,xc是根据定位标记在定标摄像机水平画面中心位置沿X轴方向的偏移像素距离,yc是根据定位标记在定标摄像机水平画面中心位置沿Y轴方向的偏移像素距离,β是标定摄像机到降落定位二维码中心点沿Y轴方向偏离的垂直角度估计,即(α,β)为无人机机身到定位标记的视觉夹角,其大小由中心点在定标摄像机画面中的像素位置和焦距共同作用,γ是机身机头朝向在水平方向上与标记点正向上的水平角度估计即机身水平偏离角度,其大小由定标摄像机画面中的定位标记轮廓指定的一边与画面坐标轴之间的夹角确定,x′c1,x′c2,y′c1,y′c2分别是定位标记轮廓中指定的一边两个端点在定标摄像机画面中的水平和垂直边的投影距离,g(H,(α,β))是最终由机身高度与垂直偏离角所确定的函数,H是机身相对降落点的高度测量值即无人机机身高度。
上述技术方案中,像素偏离距离计算:
根据定标摄像头的画面解析度计算定位标记中心点距离画面中心原点的位置即像素偏离距离(xc,yc),其中xc=x′c-Xc/2,yc=y′c-Yc/2,(Xc,Yc)为定标摄像头的画面像素解析度尺寸,其中(x′c,y′c)为定位标记中心点坐标;
根据得到的像素偏离距离(xc,yc)和定标摄像头的焦距参数,可以通过三角函数正切变换进一步得到无人机机身到定位标记的视觉夹角(α,β)。
Claims (10)
1.一种无人机自动增程巡航***的无人机自动着陆方法,包括控制站、无人机、固定式自动机库,其特征在于,无人机通过GPS及视觉引导联合定位方法完成无人机降落,
GPS及视觉引导联合定位装置实现步骤如下:
步骤1、首先根据机身GPS接收机的位置信息和降落点的坐标信息,计算降落点的位置偏差,向机身飞控***发送位置修正指令消息,控制机身进行大尺度的位置偏差修正;
步骤2、当机身到达预定降落的GPS位置坐标后,向机身飞控***发送降落准备指令,将机身高度控制在要求的降落高度上;
步骤3、启动机身定标摄像头,识别用于降落的定位标记,然后启动小尺度位置偏移计算,通过定位标记在定标摄像头画面中得到的位置计算机身到定位标记的小尺度位置偏移,根据小尺度位置偏移调整机身位置保持无人机与定位标记在误差允许的坐标范围内,从而实现无人机准确的降落在定位坐标中心。
2.根据权利要求1所述的一种无人机自动增程巡航***的无人机自动着陆方法,其特征在于,步骤1中控制机身进行大尺度的位置偏差修正,包括如下步骤:
无人机计算处理器根据预算的降落点坐标和机身GPS接收机定位坐标进行大尺度偏差控制,经过实时滤波后得到稳定的偏差值,判断当前偏差值是否满足大尺度定位门限,当大于大尺度定位门限时将该偏差值发送给机身飞行控制器,由飞行控制器控制无人机向预设的降落点GPS位置移动;当偏差值小于门限时结束大尺度偏差控制,进入小尺度偏差控制。
4.根据权利要求2所述的一种无人机自动增程巡航***的无人机自动着陆方法,其特征在于,
小尺度偏差控制:
δ(x,y)=-g(H,(α,β)),α=arctan(xc,f),β=arctan(yc,f),γ=arctan((y′c2-y′c1)/(x′c2-x′c1)),其中f为定标摄像机焦距,(xc,yc)为像素偏离距离,无人机身的水平偏移位置δ(x,y)是计算得到的无人机在水平方向上的位移偏差,α是标定摄像机到降落定位二维码中心点沿X轴方向偏离的垂直角度估计,xc是根据定位标记在定标摄像机水平画面中心位置沿X轴方向的偏移像素距离,yc是根据定位标记在定标摄像机水平画面中心位置沿Y轴方向的偏移像素距离,β是标定摄像机到降落定位二维码中心点沿Y轴方向偏离的垂直角度估计,即(α,β)为无人机机身到定位标记的视觉夹角,其大小由中心点在定标摄像机画面中的像素位置和焦距共同作用,γ是机身机头朝向在水平方向上与标记点正向上的水平角度估计即机身水平偏离角度,其大小由定标摄像机画面中的定位标记轮廓指定的一边与画面坐标轴之间的夹角确定,x′c1,x′c2,y′c1,y′c2分别是定位标记轮廓中指定的一边两个端点在定标摄像机画面中的水平和垂直边的投影距离,g(H,(α,β))是最终由机身高度与垂直偏离角所确定的函数,H是机身相对降落点的高度测量值即无人机机身高度。
5.根据权利要求4所述的一种无人机自动增程巡航***的无人机自动着陆方法,其特征在于,
像素偏离距离计算
根据定标摄像头的画面解析度计算定位标记中心点距离画面中心原点的位置即像素偏离距离(xc,yc),其中xc=x′c-Xc/2,yc=y′c-Yc/2,(Xc,Yc)为定标摄像头的画面像素解析度尺寸,其中(x′c,y′c)为定位标记中心点坐标;
根据得到的像素偏离距离(xc,yc)和定标摄像头的焦距参数,可以通过三角函数正切变换进一步得到无人机机身到定位标记的视觉夹角(α,β)。
6.一种无人机自动增程巡航***的无人机自动着陆装置,包括控制站、无人机、固定式自动机库,其特征在于,无人机通过GPS及视觉引导联合定位模块完成无人机降落,
GPS及视觉引导联合定位模块包括:
大尺度修正模块、首先根据机身GPS接收机的位置信息和降落点的坐标信息,计算降落点的位置偏差,向机身飞控***发送位置修正指令消息,控制机身进行大尺度的位置偏差修正,当机身到达预定降落的GPS位置坐标后,向机身飞控***发送降落准备指令,将机身高度控制在要求的降落高度上;
小尺度修正模块、启动机身定标摄像头,识别用于降落的定位标记,然后启动小尺度位置偏移计算,通过定位标记在定标摄像头画面中得到的位置计算机身到定位标记的小尺度位置偏移,根据小尺度位置偏移调整机身位置保持无人机与定位标记在误差允许的坐标范围内,从而实现无人机准确的降落在定位坐标中心。
7.根据权利要求6所述的一种无人机自动增程巡航***的无人机自动着陆装置,其特征在于,大尺度修正模块:
无人机计算处理器根据预算的降落点坐标和机身GPS接收机定位坐标进行大尺度偏差控制,经过实时滤波后得到稳定的偏差值,判断当前偏差值是否满足大尺度定位门限,当大于大尺度定位门限时将该偏差值发送给机身飞行控制器,由飞行控制器控制无人机向预设的降落点GPS位置移动;当偏差值小于门限时结束大尺度偏差控制,进入小尺度偏差控制。
9.根据权利要求8所述的一种无人机自动增程巡航***的无人机自动着陆装置,其特征在于,
小尺度偏差控制:
δ(x,y)=-g(H,(α,β)),α=arctan(xc,f),β=arctan(yc,f),γ=arctan((y′c2-y′c1)/(x′c2-x′c1)),其中f为定标摄像机焦距,(xc,yc)为像素偏离距离,无人机身的水平偏移位置δ(x,y)是计算得到的无人机在水平方向上的位移偏差,α是标定摄像机到降落定位二维码中心点沿X轴方向偏离的垂直角度估计,xc是根据定位标记在定标摄像机水平画面中心位置沿X轴方向的偏移像素距离,yc是根据定位标记在定标摄像机水平画面中心位置沿Y轴方向的偏移像素距离,β是标定摄像机到降落定位二维码中心点沿Y轴方向偏离的垂直角度估计,即(α,β)为无人机机身到定位标记的视觉夹角,其大小由中心点在定标摄像机画面中的像素位置和焦距共同作用,γ是机身机头朝向在水平方向上与标记点正向上的水平角度估计即机身水平偏离角度,其大小由定标摄像机画面中的定位标记轮廓指定的一边与画面坐标轴之间的夹角确定,x′c1,x′c2,y′c1,y′c2分别是定位标记轮廓中指定的一边两个端点在定标摄像机画面中的水平和垂直边的投影距离,g(H,(α,β))是最终由机身高度与垂直偏离角所确定的函数,H是机身相对降落点的高度测量值即无人机机身高度。
10.根据权利要求6所述的一种无人机自动增程巡航***的无人机自动着陆装置,其特征在于,
像素偏离距离计算
根据定标摄像头的画面解析度计算定位标记中心点距离画面中心原点的位置即像素偏离距离(xc,yc),其中xc=x′c-Xc/2,yc=y′c-Yc/2,(Xc,Yc)为定标摄像头的画面像素解析度尺寸,其中(x′c,y′c)为定位标记中心点坐标;
根据得到的像素偏离距离(xc,yc)和定标摄像头的焦距参数,可以通过三角函数正切变换进一步得到无人机机身到定位标记的视觉夹角(α,β)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210077725.5A CN114355982A (zh) | 2022-01-24 | 2022-01-24 | 无人机自动增程巡航***的无人机自动着陆方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210077725.5A CN114355982A (zh) | 2022-01-24 | 2022-01-24 | 无人机自动增程巡航***的无人机自动着陆方法及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114355982A true CN114355982A (zh) | 2022-04-15 |
Family
ID=81091895
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210077725.5A Pending CN114355982A (zh) | 2022-01-24 | 2022-01-24 | 无人机自动增程巡航***的无人机自动着陆方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114355982A (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015160230A1 (ko) * | 2014-04-18 | 2015-10-22 | 주식회사 대한항공 | 무인 항공기 자동착륙 방법 |
CN105387860A (zh) * | 2015-12-16 | 2016-03-09 | 西北工业大学 | 结合单目视觉与激光测距的无人机自主着陆导引方法 |
CN111003192A (zh) * | 2019-12-30 | 2020-04-14 | 南京信息工程大学 | 一种基于gps与视觉的无人机自主着陆***和着陆方法 |
CN112947526A (zh) * | 2021-03-12 | 2021-06-11 | 华中科技大学 | 一种无人机自主降落方法和*** |
CN113093772A (zh) * | 2021-04-13 | 2021-07-09 | 中国计量大学 | 一种无人机机库精确降落方法 |
CN113377118A (zh) * | 2021-07-14 | 2021-09-10 | 中国计量大学 | 一种基于视觉的无人机机库多阶段精确降落方法 |
-
2022
- 2022-01-24 CN CN202210077725.5A patent/CN114355982A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015160230A1 (ko) * | 2014-04-18 | 2015-10-22 | 주식회사 대한항공 | 무인 항공기 자동착륙 방법 |
CN105387860A (zh) * | 2015-12-16 | 2016-03-09 | 西北工业大学 | 结合单目视觉与激光测距的无人机自主着陆导引方法 |
CN111003192A (zh) * | 2019-12-30 | 2020-04-14 | 南京信息工程大学 | 一种基于gps与视觉的无人机自主着陆***和着陆方法 |
CN112947526A (zh) * | 2021-03-12 | 2021-06-11 | 华中科技大学 | 一种无人机自主降落方法和*** |
CN113093772A (zh) * | 2021-04-13 | 2021-07-09 | 中国计量大学 | 一种无人机机库精确降落方法 |
CN113377118A (zh) * | 2021-07-14 | 2021-09-10 | 中国计量大学 | 一种基于视觉的无人机机库多阶段精确降落方法 |
Non-Patent Citations (2)
Title |
---|
任毅: "基于视觉引导的旋翼无人机移动平台自主着陆技术研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》, no. 10, pages 031 - 22 * |
孟学斌 等: "基于视觉的四旋翼无人机自主降落算法研究", 《控制工程》, vol. 27, no. 10, pages 1751 - 1759 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108306217B (zh) | 一种架空高压线智能自主沿导线飞行巡检***和方法 | |
CN104298248B (zh) | 旋翼无人机精确视觉定位定向方法 | |
CN109911188B (zh) | 非卫星导航定位环境的桥梁检测无人机*** | |
CN109885083A (zh) | 基于激光雷达的输电线路精细化巡检飞行平台及巡检方法 | |
CN105335733B (zh) | 一种无人机自主着陆视觉定位方法及*** | |
KR101494654B1 (ko) | 무인항공기 착륙유도 방법 및 장치와 착륙제어 방법 및 장치 | |
CN105425208A (zh) | 一种用于无人机精确导航的定位***及定位方法 | |
CN105222807A (zh) | 一种旋翼无人机精密进近航道指示器校验***及校验方法 | |
CN107407937B (zh) | 航空器着陆的自动辅助方法 | |
CN111766897B (zh) | 一种输电线路的通道巡视方法、无人机和*** | |
CN110879617A (zh) | 一种红外引导无人机降落方法及装置 | |
CN110908403A (zh) | 一种用于电力巡线无人机的自动定点降落装置及方法 | |
CN110530374B (zh) | 一种无人机天钩回收阶段航迹偏差显示方法 | |
CN205920057U (zh) | 检测结构件表面裂缝的多旋翼无人机检测平台*** | |
CN113791621A (zh) | 一种自动驾驶牵引车与飞机对接方法及*** | |
CN110673641A (zh) | 一种基于无人机的客机智能维护巡检***平台 | |
CN113359786A (zh) | 一种融合飞行高度的多旋翼无人机精准降落引导方法 | |
CN111006643A (zh) | 一种无人机遥感信息监测方法 | |
CN112925334A (zh) | 一种智能巡检无人机降落***及降落方法 | |
CN113778137A (zh) | 输电线路的无人机自主巡检方法 | |
CN114910918A (zh) | 定位方法、装置及雷达装置、无人机***、控制器和介质 | |
CN113110534A (zh) | 一种小型无人机控制与感知*** | |
CN114355982A (zh) | 无人机自动增程巡航***的无人机自动着陆方法及装置 | |
CN116597696A (zh) | 基于多样环境因素的低空飞行器避撞预警***及其方法 | |
CN205427178U (zh) | 一种用于无人机精确导航的定位*** |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20220415 |