CN116449873A - 一种系留植保无人机系统及空地协同自动作业方法 - Google Patents
一种系留植保无人机系统及空地协同自动作业方法 Download PDFInfo
- Publication number
- CN116449873A CN116449873A CN202310624383.9A CN202310624383A CN116449873A CN 116449873 A CN116449873 A CN 116449873A CN 202310624383 A CN202310624383 A CN 202310624383A CN 116449873 A CN116449873 A CN 116449873A
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- apriltag
- ground
- medicine
- 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 22
- 239000003814 drug Substances 0.000 claims abstract description 101
- 238000005507 spraying Methods 0.000 claims abstract description 44
- 239000007788 liquid Substances 0.000 claims abstract description 28
- 238000010276 construction Methods 0.000 claims abstract description 7
- 239000007921 spray Substances 0.000 claims abstract description 5
- 238000004804 winding Methods 0.000 claims description 16
- 239000011159 matrix material Substances 0.000 claims description 15
- 239000002131 composite material Substances 0.000 claims description 14
- 238000003860 storage Methods 0.000 claims description 12
- 230000009466 transformation Effects 0.000 claims description 12
- 230000033001 locomotion Effects 0.000 claims description 10
- 239000000575 pesticide Substances 0.000 claims description 8
- 238000001514 detection method Methods 0.000 claims description 6
- 230000001681 protective effect Effects 0.000 claims description 5
- 238000013519 translation Methods 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000004927 fusion Effects 0.000 claims description 3
- 238000013507 mapping Methods 0.000 claims description 3
- 238000011084 recovery Methods 0.000 claims description 3
- 239000005341 toughened glass Substances 0.000 claims description 3
- 229940079593 drug Drugs 0.000 claims 1
- 230000009286 beneficial effect Effects 0.000 abstract description 3
- 241000196324 Embryophyta Species 0.000 description 23
- 230000002159 abnormal effect Effects 0.000 description 3
- 229920000049 Carbon (fiber) Polymers 0.000 description 2
- 239000004917 carbon fiber Substances 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 230000002452 interceptive effect Effects 0.000 description 2
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 description 2
- 238000003032 molecular docking Methods 0.000 description 2
- 239000000126 substance Substances 0.000 description 2
- 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 1
- 244000089409 Erythrina poeppigiana Species 0.000 description 1
- 235000009776 Rathbunia alamosensis Nutrition 0.000 description 1
- 238000012271 agricultural production Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 238000007639 printing Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012800 visualization Methods 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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/70—Energy storage systems for electromobility, e.g. batteries
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)
Abstract
本发明公开一种系留植保无人机系统及空地协同自动作业方法,该方法包括以下步骤:通过行走机构搭载无人机移动至待喷施的区域中;利用地面传感器收集作业区域信息,得到全局作业地图;根据植保目标作物生长情况、电源线和药管的长度以及全局作业地图,设定局部作业点;通过地面控制器控制行走机构移动至全局作业地图中的首个局部作业点;无人机携带者电源线和药管从停靠平台上起飞;通过药管将药箱中的药液输送至喷药机构中,由喷药机构将药液喷向农作物,直至完成该区域的喷施工作,无人机降落;移动至下一个局部作业点,按照上述操作,直至全部喷施作业。本发明可以有效解决续航短的问题,能够长时间执行喷施作业,有利于提高工作效率。
Description
技术领域
本发明涉及植保无人机及作业方法,具体涉及一种系留植保无人机系统及空地协同自动作业方法。
背景技术
农业植保是保障农业生产和农产品质量的重要手段。植保无人机实现了对农作物的精准作业,提高了农药的有效使用率,但在实际应用中,植保无人机不可避免存在一些缺点和局限性。首先,电池续航能力是植保无人机作业时间的主要制约因素之一。由于目前的电池技术水平限制,植保无人机的单次作业时间有限,往往不能满足大面积农田的作业需求。其次,植保无人机的机体负重能力也是一个重要的限制因素。机体负重能力较低时,植保无人机需要多次起降以更换药液,影响了整个作业流程的连贯性和效率。
发明内容
本发明的目的在于克服上述存在的问题,提供一种系留植保无人机系统,该系留植保无人机系统可以有效解决续航问题,能够长时间执行喷施作业,有利于提高工作效率。
本发明的另一个目的在于提供一种系留植保无人机空地协同自动作业方法。
本发明的目的通过以下技术方案实现:
一种系留植保无人机系统,包括空中作业单元和地面供给单元;
所述空中作业单元包括无人机以及设置在无人机上的喷药机构;
所述地面供给单元包括行走机构以及设置在行走机构上的药液供给机构、电源供给机构、停靠平台;所述药液供给机构包括用于存放药液的药箱和用于输送药液的药管,所述药管的两端分别连接药箱和喷药机构;所述电源供给机构包括蓄电池和电源线,所述电源线的两端分别连接蓄电池和无人机;
在非工作状态下,所述无人机停靠在停靠平台上。
上述系留植保无人机系统的工作原理为:
工作时,先往药箱注入待喷施的药液,并将蓄电池充满电;通过行走机构搭载无人机移动至待喷施的区域中;通过电源将蓄电池的电能输送至无人机上,无人机携带者电源线和药管从停靠平台上起飞;通过药管将药箱中的药液输送至喷药机构中,由喷药机构将药液喷向农作物,直至完成该区域的喷施工作;无人机降落在停靠平台上;行走机构移动至下一个待喷施的区域,按照上述操作,继续执行喷药工作,直至全部喷施作业。
本发明的一个优选方案,其中,所述喷药机构包括输药碳纤管和喷药头。
本发明的一个优选方案,其中,所述地面供给单元还包括收放机构,该收放机构包括收放驱动电机和收放盘,所述收放盘与所述收放驱动电机的输出轴连接;
所述电源线和药管缠绕在所述收放盘上。通过上述结构,在无人机降落时,可以通过收放驱动电机驱动收放盘对电源线和药管进行有序收卷;在无人机起飞时,可以通过收放驱动电机驱动收放盘将电源线和药管放出来。
进一步,所述收放机构还包括收放复合管,该收放复合管两端分别固定连接在收放盘和无人机上;所述电源线和药管的非端部部位均设置在所述收放复合管中。这样,可以防止树枝等异物干涉电源线和药管,也防止电源线和药管之间发生缠绕和打结等现象。
进一步,所述收放机构还包括收放保护罩,该收放保护罩设置在收放盘的上方;所述收放保护罩上设有多个出线孔。
本发明的一个优选方案,其中,所述空中作业单元设有多个,这样可以同时执行多组喷施工作,加快作业效率。
本发明的一个优选方案,其中,所述药箱和蓄电池均设置在供给控制舱内,该供给控制舱的顶部构成所述停靠平台。
本发明的一个优选方案,其中,所述停靠平台上设有若干个Apriltags组合标签模块,所述Apriltags组合标签模块由至少两个具有不同特征信息的子Apriltag构成。
进一步,所述Apriltags组合标签模块的表面覆盖有钢化玻璃,以便对Apriltag码进行防护。
本发明的一个优选方案,其中,所述地面供给单元还包括地面控制器,所述地面控制器分别与无人机、喷药机构、行走机构连接,用于接收传感器信息以及发布控制信息。
进一步,所述地面供给单元还包括地面传感器,该地面传感器与地面控制器连接;
所述地面传感器包括里程计、激光雷达和地面深度相机。
本发明的一个优选方案,其中,所述空中作业单元还包括空中传感器,该空中传感器包括激光测距仪、俯视深度相机和前视深度相机。
一种系留植保无人机空地协同自动作业方法,包括以下步骤:
通过行走机构搭载无人机移动至待喷施的区域中;利用地面传感器收集作业区域信息,通过地面控制器将得到的信息进行建图,得到全局作业地图;
根据植保目标作物生长情况、电源线和药管的长度以及全局作业地图,设定局部作业点;
通过地面控制器控制行走机构移动至全局作业地图中的首个局部作业点;
通过电源将蓄电池的电能输送至无人机上,无人机携带者电源线和药管从停靠平台上起飞;通过药管将药箱中的药液输送至喷药机构中,由喷药机构将药液喷向农作物,直至完成该区域的喷施工作,无人机降落在停靠平台上;
通过地面控制器控制行走机构移动至下一个局部作业点,按照上述操作,继续执行喷药工作,直至全部喷施作业。
本发明的一个优选方案,其中,采用cartographer_ros功能包实现全局作业地图的生成:
为行走机构创建一个URDF模型,并描述里程计、激光雷达、地面深度相机的位置和参数;配置cartographer_ros的参数文件;通过人工驾驶行走机构在作业场景进行环境信息采集,通过地面控制器将收到的信息利用cartograper_ros运行cartographer的SLAM算法,发布位置估计和子图列表,从子图列表生成一个占据栅格地图,得到全局作业地图。
本发明的一个优选方案,其中,利用ROS机器人操作系统中的move_base导航框架,在此框架上实现行走机构的运动规划,通过全局作业地图和局部作业点规划作业路线;
move_base实时获取全局作业地图,通过里程计获取行走机构当前位置和局部作业点位置,生成行走机构的本地规划器、全局规划器以及一个代价地图定义;
当任务开始时,move_base利用全局规划器计算出全局规划的路径点序列,再根据局部作业点将全局规划路径点序列分割成若干子段,再利用激光雷达和地面深度相机采集的信息进行局部路径规划,并在该子段内进行运动控制,实现在局部区域内精准完成轨迹跟踪,通过里程计获取行走机构当前位置判断是否已经到达局部作业点附近,以停止行走机构运动,等待局部作业完成。
本发明的一个优选方案,其中,通过安装在无人机底部的俯视深度相机获取到Apriltags组合标签模块的位置信息;通过坐标转换将Apriltags组合标签模块里的每一个子Apriltag的可获取到的位置信息进行融合后,转换为俯视深度相机坐标系下的位置信息;
通过加权平均法对每一个子Apriltag进行位置信息融合,对识别每个apriltag得到的相机位置按照其置信度赋予不同的权重,将加权平均值作为最终估计值,以俯视深度相机相机位置的估计精度,提高无人机位置的估计精度;将俯视深度相机坐标系下的位置信息转换为无人机坐标系下的位置信息,以此获取无人机的位置信息,实现无人机的局部定位以及控制。
进一步,采用apriltag_ros作为Apriltag的检测算法,将采集得到的图像信息作为该算法的输入,该算法输出检测信息;采集得到的图像信息提供子Apriltag的id信息和俯视深度相机相对于子Apriltag的位置信息,包括平移向量Tct和旋转矩阵Rct;
在装配空中作业单元时,获得无人机与俯视深度相机的平移向量平移向量Tdc和旋转矩阵Rdc,则无人机到子Apriltag的变换关系为:
T_uq=[Rct,Tct]*[Rdc,Tdc]-1;
其中T_uq表示从无人机坐标系到子Apriltag坐标系的变换关系矩阵,[Rct,Tct]表示俯视深度相机坐标系到子Apriltag坐标系的变换矩阵,[Rdc,Tdc]-1是俯视深度相机坐标系到无人机坐标系的逆变换矩阵;
将子Apriltag的真实坐标定义为P_Q,通过T_uq将其变换到无人机坐标系中,得到无人机局部坐标P_U:
P_U=T_uq*P_Q。
进一步,将Apriltags组合标签模块中间的子Apriltag中心设为局部原点,即真实坐标为(0,0,0),其余子Apriltag的真实坐标系按真实物理距离相应设定;
在检测子Apriltag时,把得到的位置信息中的距离作为置信度,距离俯视深度相机越远的子Apriltag的置信度越低,相应权重W越低;权重W通过以下方式得到:
Wi=(第i个子Apriltag与俯视深度相机的距离)/(Apriltags组合标签模块中所有子Apriltag与俯视深度相机的距离之和);
无人机局部坐标P_U:
其中,
本发明的一个优选方案,其中,通过Apriltags组合标签模块实现精准降落的方法为:
降落时无人机保持与Apriltags组合标签模块同一x,y轴方向;
当id为0的Apriltag未被遮挡时,将俯视深度相机的图像中心点与识别到的id为0的Apriltag的像素中心点做差,将差值反馈作为无人机在x、y轴上的运动;
当id为0的Apriltag被遮挡时,则采取其它子Apriltag作为降落参考点,设定其它子Apriltag的id为X;
设id为X的Apriltag的实际边长为Real,像素边长为Pix;设id为X的Apriltag的中心点到id为0的Apriltag的中心点实际距离长度为Rdistance,像素距离长度为Pdistance;其中,Real、Rdistance为已知,Pix由相机采集的图像获得,则得到:
Pdistance=(Pix/Real)*Rdistance;
根据三角函数关系:
A=sina.
B=cosθ.Pdistance
根据勾股定理求出被遮挡的id为0的Apriltag的像素中心点,实现定位信息恢复;
当检测到此外在无人机降落到较低高度时,俯视深度相机会因焦距问题无法识别Apriltag,此时再结合激光测距仪完成降落。
本发明的一个优选方案,其中,设无人机的高度为H,设收放复合管的放出的长度为L,那么H与L存在以下关系:
H=kL,k为常数;
那么收放驱动电机的转动速度v为:
v=2πR/t*dL/dt;
其中,R是收放盘的半径,t是收放驱动电机转一圈需要的时间,dL/dt是收放复合管的放出的长度L随时间t变化的速率。
本发明与现有技术相比具有以下有益效果:
本发明的系留植保无人机系统通过设置停留在地面的药液供给机构和电源供给机构,无人机可以空载飞行,由地面的药液供给机构和电源供给机构进行送电和送药,可以有效解决续航问题,能够长时间执行喷施作业,有利于提高工作效率。
附图说明
图1为本发明的系留植保无人机系统在作业状态下的立体结构示意图。
图2-3为本发明的空中作业单元的两个不同视角的立体结构示意图。
图4为本发明的地面供给单元的立体结构示意图。
图5为本发明的地面供给单元的供给控制舱的内部结构图。
图6为本发明的收放机构的立体爆炸示意图。
图7为本发明的收放机构的线束的部分立体结构图。
图8为本发明的Apriltags组合标签模块的示意图。
图9为本发明的空中作业单元在降落时当其中一个Apriltag被遮挡时的求解示意图。
图10为本发明的系留植保无人机系统的作业示意图。
具体实施方式
为了使本领域的技术人员很好地理解本发明的技术方案,下面结合实施例和附图对本发明作进一步描述,但本发明的实施方式不仅限于此。
参见图1-3,本实施例的系留植保无人机系统,包括空中作业单元和地面供给单元;所述空中作业单元包括无人机1以及设置在无人机1上的喷药机构、空中传感器;所述空中作业单元设有四个,这样可以同时执行四组喷施工作,加快作业效率。
参见图2-3,所述无人机1包括主体板1-1、四个起落架1-2、桨叶保护罩1-3和电机桨叶套1-4,由供电口进行供电,飞控模块1-6安装在顶部中心;所述喷药机构固定设置在所述主体板1-1上,所述喷药机构包括输药碳纤管2和喷药头3。
参见图2-3,所述空中传感器包括激光测距仪4、俯视深度相机5和前视深度相机6。
参见图1和图4-5,所述地面供给单元包括行走机构7以及设置在行走机构7上的药液供给机构、电源供给机构、停靠平台;所述药液供给机构包括用于存放药液的药箱8和用于输送药液的药管9,所述药管9的两端分别连接药箱8和喷药机构;所述电源供给机构包括蓄电池10和电源线11,所述电源线11的两端分别连接蓄电池10和无人机1;其中,所述药箱8和蓄电池10均设置在供给控制舱12内,该供给控制舱12的顶部构成所述停靠平台。
参见图4-5,所述地面供给单元还包括地面控制器13和地面传感器,所述地面控制器13分别与地面传感器、无人机1、喷药机构、行走机构7连接,用于接收传感器信息以及发布控制信息;所述地面传感器包括里程计14、激光雷达15和地面深度相机16。
具体地,所述地面控制器13其在基于Linux内核的ubuntu18.04系统上运行ROS机器人操作系统,版本号为melodic,同时运行程序实现空地协同自动作业。
参见图4-5,所述供给控制舱12上安装有三个状态灯,分别为药箱状态灯17、作业状态灯18和电源状态灯19;其中,药箱状态灯17为绿灯表示工作正常,药箱状态灯17为红灯表示工作异常,药箱状态灯17为黄灯表示需补充农药,可通过充药口20进行补充;作业状态灯18为绿灯闪烁表示无人机1处于启动状态,作业状态灯18为绿灯常亮表示无人机1处于未启动状态,作业状态灯18为红灯表示工作异常;电源状态灯19为绿灯表示工作正常,电源状态灯19红灯表示工作异常,电源状态灯19黄灯表示需充电,可通过充电口21进行充电。
参见图4-6,所述地面供给单元还包括收放机构,该收放机构包括收放驱动电机22和收放盘23,所述收放盘23与所述收放驱动电机22的输出轴连接;所述电源线11和药管9缠绕在所述收放盘23上。通过上述结构,在无人机1降落时,可以通过收放驱动电机22驱动收放盘23对电源线11和药管9进行有序收卷;在无人机1起飞时,可以通过收放驱动电机22驱动收放盘23将电源线11和药管9放出来。
进一步,所述收放机构还包括收放复合管24,该收放复合管24两端分别固定连接在收放盘23和无人机1上;所述电源线11和药管9的非端部部位均设置在所述收放复合管24中(实际上,还包括信号线设包在收放复合管24中)。这样,可以防止树枝等异物干涉电源线11和药管9,也防止电源线11和药管9之间发生缠绕和打结等现象。
进一步,所述收放机构还包括收放保护罩25,该收放保护罩25设置在收放盘23的上方;所述收放保护罩25上设有多个出线孔。
参见图4-5,所述停靠平台上设有四个Apriltags组合标签模块26,所述Apriltags组合标签模块26由至少两个具有不同特征信息的子Apriltag构成;具体地,所述Apriltags组合标签模块26选用25个种类为TAG36H11,id由0到24的Apriltag,然后每个Apriltags组合标签模块26均由五个Apriltag呈“X”状组合打印在纸上而成,且在纸表面覆盖了一块钢化玻璃作为保护,可避免单个Apriltags信息鲁棒性不够的问题,提高无人机1定位精度与准确度。
参见图1-5和图8-10,本实施例的系留植保无人机1空地协同自动作业方法,包括以下步骤:
步骤一、通过行走机构7搭载无人机1移动至待喷施的区域中;利用地面传感器收集作业区域信息,通过地面控制器13将得到的信息进行建图,得到全局作业地图。
具体地,采用cartographer_ros功能包实现全局作业地图的生成,cartographer_ros是一个提供cartographer与ROS机器人操作系统集成的项目;cartographer是一个开源的SLAM系统,可以在2D和3D中提供实时的同时定位和建图。
为行走机构7创建一个URDF模型,并描述里程计14、激光雷达15、地面深度相机16的位置和参数;配置cartographer_ros的参数文件;通过人工驾驶行走机构7在作业场景进行环境信息采集,通过地面控制器13将收到的信息利用cartograper_ros运行cartographer的SLAM算法,发布位置估计和子图列表,从子图列表生成一个占据栅格地图,得到全局作业地图。
步骤二、根据植保目标作物生长情况、电源线11和药管9的长度以及全局作业地图,设定局部作业点;利用三维可视化平台Rviz软件打开全局作业地图实现局部作业点的设定,在rviz中使用PublishPoint工具选择几个点作为局部作业点,并记录和设定它们在地图坐标系下的位置(x,y,z)。
步骤三、通过地面控制器13控制行走机构7移动至全局作业地图中的首个局部作业点。
具体地,利用ROS机器人操作系统中的move_base导航框架,在此框架上实现行走机构7的运动规划,通过全局作业地图和局部作业点规划作业路线。
通过move_base实时获取全局作业地图,通过里程计14获取行走机构7当前位置和局部作业点位置,生成行走机构7的本地规划器、全局规划器以及一个代价地图定义。
当任务开始时,move_base利用全局规划器计算出全局规划的路径点序列,再根据局部作业点将全局规划路径点序列分割成若干子段,再利用激光雷达15和地面深度相机16采集的信息进行局部路径规划,并在该子段内进行运动控制,实现在局部区域内精准完成轨迹跟踪,通过里程计14获取行走机构7当前位置判断是否已经到达局部作业点附近,以停止行走机构7运动,等待局部作业完成。
步骤四、通过电源将蓄电池10的电能输送至无人机1上,无人机1携带者电源线11和药管9从停靠平台上起飞;通过药管9将药箱8中的药液输送至喷药机构中,由喷药机构将药液喷向农作物,直至完成该区域的喷施工作,无人机1降落在停靠平台上。
具体地,通过安装在无人机1底部的俯视深度相机5获取到Apriltags组合标签模块26的位置信息;通过坐标转换将Apriltags组合标签模块26里的每一个子Apriltag的可获取到的位置信息进行融合后,转换为俯视深度相机5坐标系下的位置信息;
通过加权平均法对每一个子Apriltag进行位置信息融合,对识别每个apriltag得到的相机位置按照其置信度赋予不同的权重,将加权平均值作为最终估计值,以俯视深度相机5相机位置的估计精度,提高无人机1位置的估计精度;将俯视深度相机5坐标系下的位置信息转换为无人机1坐标系下的位置信息,以此获取无人机1的位置信息,实现无人机1的局部定位以及控制。
进一步,采用apriltag_ros作为Apriltag的检测算法,将采集得到的图像信息作为该算法的输入,该算法输出检测信息;采集得到的图像信息提供子Apriltag的id信息和俯视深度相机5相对于子Apriltag的位置信息,包括平移向量Tct和旋转矩阵Rct。
在装配空中作业单元时,获得无人机1与俯视深度相机5的平移向量平移向量Tdc和旋转矩阵Rdc,则无人机1到子Apriltag的变换关系为:
T_uq=[Rct,Tct]*[Rdc,Tdc]-1;
其中T_uq表示从无人机1坐标系到子Apriltag坐标系的变换关系矩阵,[Rct,Tct]表示俯视深度相机5坐标系到子Apriltag坐标系的变换矩阵,[Rdc,Tdc]-1是俯视深度相机5坐标系到无人机1坐标系的逆变换矩阵。
将子Apriltag的真实坐标定义为P_Q,通过T_uq将其变换到无人机1坐标系中,得到无人机1局部坐标P_U:
P_U=T_uq*P_Q。
进一步,将Apriltags组合标签模块26中间的子Apriltag中心设为局部原点,即真实坐标为(0,0,0),其余子Apriltag的真实坐标系按真实物理距离相应设定。
在检测子Apriltag时,把得到的位置信息中的距离作为置信度,距离俯视深度相机5越远的子Apriltag的置信度越低,相应权重W越低;权重W通过以下方式得到:
Wi=(第i个子Apriltag与俯视深度相机5的距离)/(Apriltags组合标签模块中所有子Apriltag与俯视深度相机5的距离之和)。
无人机1局部坐标P_U:
其中,
进一步,通过Apriltags组合标签模块26实现精准降落的方法为:
降落时无人机1保持与Apriltags组合标签模块26同一x,y轴方向。
当id为0的Apriltag未被遮挡时,将俯视深度相机5的图像中心点与识别到的id为0的Apriltag的像素中心点做差,将差值反馈作为无人机1在x、y轴上的运动。
当id为0的Apriltag被遮挡时,则采取其它子Apriltag作为降落参考点,设定其它子Apriltag的id为X。
设id为X的Apriltag的实际边长为Real,像素边长为Pix;设id为X的Apriltag的中心点到id为0的Apriltag的中心点实际距离长度为Rdistance,像素距离长度为Pdistance;其中,Real、Rdistance为已知,Pix由相机采集的图像获得,则得到:
Pdistance=(Pix/Real)*Rdistance;
根据三角函数关系:
A=sinθ·Pdistance;
B=cosθ·Pdistance;
根据勾股定理求出被遮挡的id为0的Apriltag的像素中心点,实现定位信息恢复。
当检测到此外在无人机1降落到较低高度时,俯视深度相机5会因焦距问题无法识别Apriltag,此时再结合激光测距仪4完成降落。
进一步,设无人机1的高度为H,设收放复合管24的放出的长度为L,那么H与L存在以下关系:
H=kL,k为常数。
那么收放驱动电机22的转动速度v为:
v=2πR/t*dL/dt。
其中,R是收放盘23的半径,t是收放驱动电机22转一圈需要的时间,dL/dt是收放复合管24的放出的长度L随时间t变化的速率。
步骤五、按照上述操作,通过地面控制器13控制行走机构7移动至下一个局部作业点,继续执行喷药工作,直至全部喷施作业。
参见图1-5和图8-10,本实施例的系留植保无人机系统的作业方式为:
在实际作业场景中,有三列树,每列共有八棵树,首先由人工驾驶行走机构7从Start沿着全局作业路径驾驶到End,同时利用地面供给单元所搭载的里程计14、激光雷达15和地面深度相机16对作业环境数据进行采集,同时地面控制器13利用采集到的数据生成全局作业图,然后根据作业需求设定局部作业点A至H,至此,地面供给单元预备工作准备完成。
地面供给单元从start点开始自动作业,地面控制器13根据已知的全局作业图以及局部作业点,控制行走机构7移动到第一个局部作业点A,然后地面控制器13发布作业指令,无人机1开始工作,地面控制器13通过空中传感器反馈的信息控制无人机1和喷药机构进行作业,作业完成后再控制其降落回地面供给单元,在所有无人机1降落返回后,行走机构7将移动到局部作业点B进行作业,直至完成局部作业点G的作业任务。
上述为本发明较佳的实施方式,但本发明的实施方式并不受上述内容的限制,其他的任何未背离本发明的精神实质与原理下所做的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。
Claims (10)
1.一种系留植保无人机系统,其特征在于,包括空中作业单元和地面供给单元;
所述空中作业单元包括无人机以及设置在无人机上的喷药机构;
所述地面供给单元包括行走机构以及设置在行走机构上的药液供给机构、电源供给机构、停靠平台;所述药液供给机构包括用于存放药液的药箱和用于输送药液的药管,所述药管的两端分别连接药箱和喷药机构;所述电源供给机构包括蓄电池和电源线,所述电源线的两端分别连接蓄电池和无人机;
在非工作状态下,所述无人机停靠在停靠平台上。
2.根据权利要求1所述的系留植保无人机系统,其特征在于,所述地面供给单元还包括收放机构,该收放机构包括收放驱动电机和收放盘,所述收放盘与所述收放驱动电机的输出轴连接;
所述收放机构还包括收放复合管,该收放复合管两端分别固定连接在收放盘和无人机上;所述电源线和药管的非端部部位均设置在所述收放复合管中;
所述收放机构还包括收放保护罩,该收放保护罩设置在收放盘的上方;所述收放保护罩上设有多个出线孔。
3.根据权利要求1所述的系留植保无人机系统,其特征在于,所述药箱和蓄电池均设置在供给控制舱内,该供给控制舱的顶部构成所述停靠平台;
所述停靠平台上设有若干个Apriltags组合标签模块,所述Apriltags组合标签模块由至少两个具有不同特征信息的子Apriltag构成;
所述Apriltags组合标签模块的表面覆盖有对Apriltag码进行防护的钢化玻璃。
4.根据权利要求1所述的系留植保无人机系统,其特征在于,所述地面供给单元还包括地面控制器,所述地面控制器分别与无人机、喷药机构、行走机构连接,用于接收传感器信息以及发布控制信息;
所述地面供给单元还包括地面传感器,该地面传感器与地面控制器连接;所述地面传感器包括里程计、激光雷达和地面深度相机;
所述空中作业单元还包括空中传感器,该空中传感器包括激光测距仪、俯视深度相机和前视深度相机。
5.一种应用于权利要求1-4任一项的系留植保无人机系统的空地协同自动作业方法,其特征在于,包括以下步骤:
通过行走机构搭载无人机移动至待喷施的区域中;利用地面传感器收集作业区域信息,通过地面控制器将得到的信息进行建图,得到全局作业地图;
根据植保目标作物生长情况、电源线和药管的长度以及全局作业地图,设定局部作业点;
通过地面控制器控制行走机构移动至全局作业地图中的首个局部作业点;
通过电源将蓄电池的电能输送至无人机上,无人机携带者电源线和药管从停靠平台上起飞;通过药管将药箱中的药液输送至喷药机构中,由喷药机构将药液喷向农作物,直至完成该区域的喷施工作,无人机降落在停靠平台上;
通过地面控制器控制行走机构移动至下一个局部作业点,按照上述操作,继续执行喷药工作,直至全部喷施作业。
6.根据权利要求5所述的空地协同自动作业方法,其特征在于,利用ROS机器人操作系统中的move_base导航框架,在此框架上实现行走机构的运动规划,通过全局作业地图和局部作业点规划作业路线;
move_base实时获取全局作业地图,通过里程计获取行走机构当前位置和局部作业点位置,生成行走机构的本地规划器、全局规划器以及一个代价地图定义;
当任务开始时,move_base利用全局规划器计算出全局规划的路径点序列,再根据局部作业点将全局规划路径点序列分割成若干子段,再利用激光雷达和地面深度相机采集的信息进行局部路径规划,并在该子段内进行运动控制,实现在局部区域内精准完成轨迹跟踪,通过里程计获取行走机构当前位置判断是否已经到达局部作业点附近,以停止行走机构运动,等待局部作业完成。
7.根据权利要求5所述的空地协同自动作业方法,其特征在于,通过安装在无人机底部的俯视深度相机获取到Apriltags组合标签模块的位置信息;通过坐标转换将Apriltags组合标签模块里的每一个子Apriltag的可获取到的位置信息进行融合后,转换为俯视深度相机坐标系下的位置信息;
通过加权平均法对每一个子Apriltag进行位置信息融合,对识别每个apriltag得到的相机位置按照其置信度赋予不同的权重,将加权平均值作为最终估计值,以俯视深度相机相机位置的估计精度,提高无人机位置的估计精度;将俯视深度相机坐标系下的位置信息转换为无人机坐标系下的位置信息,以此获取无人机的位置信息,实现无人机的局部定位以及控制。
8.根据权利要求7所述的空地协同自动作业方法,其特征在于,采用apriltag_ros作为Apriltag的检测算法,将采集得到的图像信息作为该算法的输入,该算法输出检测信息;采集得到的图像信息提供子Apriltag的id信息和俯视深度相机相对于子Apriltag的位置信息,包括平移向量Tct和旋转矩阵Rct;
在装配空中作业单元时,获得无人机与俯视深度相机的平移向量平移向量Tdc和旋转矩阵Rdc,则无人机到子Apriltag的变换关系为:
T_uq=[Rct,Tct]*[Rdc,Tdc]-1;
其中T_uq表示从无人机坐标系到子Apriltag坐标系的变换关系矩阵,[Rct,Tct]表示俯视深度相机坐标系到子Apriltag坐标系的变换矩阵,[Rdc,Tdc]-1是俯视深度相机坐标系到无人机坐标系的逆变换矩阵;
将子Apriltag的真实坐标定义为P_Q,通过T_uq将其变换到无人机坐标系中,得到无人机局部坐标P_U:
P_U=T_uq*P_Q。
9.根据权利要求8所述的空地协同自动作业方法,其特征在于,将Apriltags组合标签模块中间的子Apriltag中心设为局部原点,即真实坐标为(0,0,0),其余子Apriltag的真实坐标系按真实物理距离相应设定;
在检测子Apriltag时,把得到的位置信息中的距离作为置信度,距离俯视深度相机越远的子Apriltag的置信度越低,相应权重W越低;权重W通过以下方式得到:
Wi=(第i个子Apriltag与俯视深度相机的距离)/(Apriltags组合标签模块中所有子Apriltag与俯视深度相机的距离之和);
无人机局部坐标P_U:
其中,
10.根据权利要求9所述的空地协同自动作业方法,其特征在于,通过Apriltags组合标签模块实现精准降落的方法为:
降落时无人机保持与Apriltags组合标签模块同一x,y轴方向;
当id为0的Apriltag未被遮挡时,将俯视深度相机的图像中心点与识别到的id为0的Apriltag的像素中心点做差,将差值反馈作为无人机在x、y轴上的运动;
当id为0的Apriltag被遮挡时,则采取其它子Apriltag作为降落参考点,设定其它子Apriltag的id为X;
设id为X的Apriltag的实际边长为Real,像素边长为Pix;设id为X的Apriltag的中心点到id为0的Apriltag的中心点实际距离长度为Rdistance,像素距离长度为Pdistance;其中,Real、Rdistance为已知,Pix由相机采集的图像获得,则得到:
Pdistance=(Pix/Real)*Rdistance;
根据三角函数关系:
A=sinθ·Pdistance;
B=cosθ·Pdistance;
根据勾股定理求出被遮挡的id为0的Apriltag的像素中心点,实现定位信息恢复;
当检测到此外在无人机降落到较低高度时,俯视深度相机会因焦距问题无法识别Apriltag,此时再结合激光测距仪完成降落。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310624383.9A CN116449873A (zh) | 2023-05-29 | 2023-05-29 | 一种系留植保无人机系统及空地协同自动作业方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310624383.9A CN116449873A (zh) | 2023-05-29 | 2023-05-29 | 一种系留植保无人机系统及空地协同自动作业方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116449873A true CN116449873A (zh) | 2023-07-18 |
Family
ID=87127596
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310624383.9A Pending CN116449873A (zh) | 2023-05-29 | 2023-05-29 | 一种系留植保无人机系统及空地协同自动作业方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116449873A (zh) |
-
2023
- 2023-05-29 CN CN202310624383.9A patent/CN116449873A/zh active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3423913B1 (en) | Sensor trajectory planning for a vehicle-mounted sensor | |
US11332033B2 (en) | Systems and methods for UAV battery exchange | |
US10611252B2 (en) | Systems and methods for UAV battery power backup | |
US9975632B2 (en) | Aerial vehicle system | |
US10625593B2 (en) | Self-balancing robot system comprising robotic omniwheel | |
CN104309803B (zh) | 旋翼飞行器自动降落系统及方法 | |
CN110062919A (zh) | 递送车辆的放下地点规划 | |
CN105492985A (zh) | 多传感器环境地图构建 | |
CN106314594A (zh) | 一种用于现代物流行业的仓储搬运机器人 | |
JP6791561B2 (ja) | Uavにエネルギーを供給する方法、及び装置 | |
CN209615483U (zh) | 一种具有目标跟踪和自动避障的载物爬楼机器人 | |
CN111459172A (zh) | 围界安防无人巡逻车自主导航系统 | |
CN111413963A (zh) | 多功能机器人自主配送方法及系统 | |
CN112611374A (zh) | 基于激光雷达和深度相机的路径规划及避障的方法及系统 | |
CN110162066A (zh) | 智能巡航车控制系统 | |
CN112477533B (zh) | 设施农业路轨两用运输机器人 | |
WO2021008371A1 (zh) | 结合无人机的智能物流车盘点系统 | |
CN116215697A (zh) | 粮食采样系统 | |
CN214566043U (zh) | 一种无人船和无人机协同暖涡信息采集装置 | |
CN116449873A (zh) | 一种系留植保无人机系统及空地协同自动作业方法 | |
CN113371200B (zh) | 针对规模化种植农作物的无人机精准喷药系统 | |
CN114330832A (zh) | 一种智能快递包裹配送系统及其工作方法 | |
CN207882763U (zh) | 一种多旋翼无人机自主避障装置 | |
Kang et al. | Draper unmanned vehicle systems | |
CN114604271A (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 |