CN209862068U - An autonomous navigation spraying robot for orchard operations - Google Patents
An autonomous navigation spraying robot for orchard operations Download PDFInfo
- Publication number
- CN209862068U CN209862068U CN201920506063.2U CN201920506063U CN209862068U CN 209862068 U CN209862068 U CN 209862068U CN 201920506063 U CN201920506063 U CN 201920506063U CN 209862068 U CN209862068 U CN 209862068U
- Authority
- CN
- China
- Prior art keywords
- robot
- pesticide spraying
- orchard
- control system
- spraying
- 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
Landscapes
- Catching Or Destruction (AREA)
Abstract
Description
技术领域technical field
本实用新型涉及一种用于果园作业的自主导航喷药机器人,属于农业智能装备技术领域。The utility model relates to an autonomous navigation spraying robot for orchard operations, which belongs to the technical field of agricultural intelligent equipment.
背景技术Background technique
果园管理属于劳动密集型产业,用工成本在总成本中的占比较高,且劳动力短缺问题日益凸显。果园的日常管理主要包括喷药、修剪、除草、浇水、施肥等活动,其中喷药是必不可少的作业环节之一。长期以来,广大果农主要依靠喷雾器、打药机等简易机械辅助喷药,其作业效率低,劳动强度大,且常因吸入药雾对人体健康造成危害。近年来,随着人工智能等技术的不断创新发展,智能机器人在多个行业逐渐得到应用。而在农业领域,利用智能机器人来代替人工进行果树喷药,无疑具有十分重要的现实意义。Orchard management is a labor-intensive industry, and the labor cost accounts for a relatively high proportion of the total cost, and the problem of labor shortage has become increasingly prominent. The daily management of the orchard mainly includes spraying, pruning, weeding, watering, fertilizing and other activities, among which spraying is one of the essential operations. For a long time, the majority of fruit farmers have mainly relied on simple machinery such as sprayers and sprayers to assist in spraying pesticides, which has low operating efficiency and high labor intensity, and often causes harm to human health due to inhalation of pesticide mist. In recent years, with the continuous innovation and development of artificial intelligence and other technologies, intelligent robots have gradually been applied in many industries. In the field of agriculture, it is undoubtedly of great practical significance to use intelligent robots to replace manual spraying of fruit trees.
在果园喷药机器人的技术研究和装备研制方面,国内已有相关单位和技术人员提出了各自的解决方案,对其逐一对比分析如下。In terms of technical research and equipment development of orchard spraying robots, relevant domestic units and technicians have proposed their own solutions, and their comparative analysis is as follows.
中国专利申请公布号为CN107639640A的一种多喷头智能喷药机器人,通过在多个直立且可变高度的电动推杆顶端设置喷头实现喷药,带有GPS接收机可接收位置信息,但其不足在于,在缺乏风送机构参与的情况下单靠压力喷射,其喷药距离、雾化程度及穿透树冠的效果均难以保证;另外,机器人是否无人驾驶、如何导航等信息均未给出。中国专利申请公布号为CN107678318A的一种智能喷药机器人,通过图像分析的方式实现喷药控制,用遥控器来控制机器人行走,操作人员仍需跟在机器人旁边,而非由其自主导航。中国专利申请公布号为CN108098779A的一种喷药机器人的控制系统,将喷头设置在上下调节机构上,并由主控模块进行控制,仅适用于教学试验,并无实用意义。中国专利申请公布号为CN104186451B的一种基于机器视觉的除虫除草喷药机器人,利用机器视觉识别田间草害和虫害,主要用于大田环境,且无法用于果园喷药。中国专利公开号为CN206963767U的喷药机器人,其喷药机构为弥雾机,且无导航功能。中国专利公开号为CN206651269U的一种远程遥控式智能喷药机器人,利用机械臂带动高压喷枪和雾化调节机构进行喷药,药雾覆盖面小,喷药效率低;采用遥控器控制,无导航功能。中国专利申请公开号为CN106708036A的一种基于嵌入式的喷药机器人路径导航装置及其实现方法,利用图像处理技术提取路径拟合点并进行导航控制;其不足之处在于,非针对果园环境,也未考虑果园路径的复杂性、果树枝叶遮挡、白天强光照射或夜晚弱光环境下作业等实际情况,且未给出喷药方案及效果,因此不具实用性。中国专利公开号为CN103891697B的一种室内自主移动喷药机器人的变量喷药方法,利用摄像头及超声波传感器实现在温室内的变量喷药和自主移动,不可适用于露天果园环境,无可比性。中国专利公开号为CN104820425B的一种基于电磁检测的农田智能喷药机器人和公开号为CN107544511A的果园喷药机器人的自动执行系统及自动执行方法,两者都为机器人的自主行进设置了前提条件,前者需要在路径上布设导线,后者需要在路径边缘设置挡板,在实际生产中均不具有可操作性。中国专利申请公开号为CN106719544A的一种智能喷药机器人,仅适于大田喷药,且无导航功能。中国专利申请公开号为CN108391649A的一种果园自动喷药装置,需要在田间预先铺设轨道,一是实施起来较为繁琐,且投资较大;二是轨道的铺设会对果园其他农艺活动造成影响。Chinese patent application publication number is CN107639640A a kind of multi-nozzle intelligent spraying robot, realizes spraying by arranging sprinklers on the top of multiple upright and variable-height electric push rods, with GPS receiver to receive position information, but its deficiency The reason is that it is difficult to guarantee the spraying distance, degree of atomization, and the effect of penetrating the canopy by relying on pressure spraying alone without the participation of an air delivery mechanism; in addition, information such as whether the robot is unmanned or how to navigate is not given. . The Chinese patent application publication number is CN107678318A, an intelligent spraying robot, which realizes spraying control through image analysis, and uses a remote control to control the walking of the robot. The operator still needs to follow the robot instead of autonomously navigating. The Chinese patent application publication number is CN108098779A, a control system of a spraying robot. The spray head is arranged on the up and down adjustment mechanism and controlled by the main control module. It is only suitable for teaching experiments and has no practical significance. The Chinese patent application publication number is CN104186451B, a machine vision-based pest control and herbicide spraying robot, which uses machine vision to identify field weeds and insect pests. It is mainly used in field environments and cannot be used for orchard spraying. The Chinese patent publication number is the spraying robot of CN206963767U, and its spraying mechanism is a mist machine, and has no navigation function. The Chinese patent publication number is CN206651269U, a remote-controlled intelligent spraying robot, which uses a mechanical arm to drive a high-pressure spray gun and an atomization adjustment mechanism for spraying. The coverage of the spray is small and the spraying efficiency is low; it is controlled by a remote control and has no navigation function. . Chinese patent application publication number is CN106708036A, a kind of path navigation device based on embedded spraying robot and its implementation method, which uses image processing technology to extract path fitting points and carry out navigation control; its disadvantage is that it is not aimed at the orchard environment, It also does not consider the complexity of the orchard path, the occlusion of fruit tree branches and leaves, the strong light during the day or the operation under low light at night, and does not give the spraying plan and effect, so it is not practical. The Chinese patent publication number is CN103891697B, a variable spraying method of an indoor autonomous mobile spraying robot, which uses a camera and an ultrasonic sensor to realize variable spraying and autonomous movement in a greenhouse, which is not applicable to an open-air orchard environment and is incomparable. The Chinese Patent Publication No. is CN104820425B, a farmland intelligent spraying robot based on electromagnetic detection and the automatic execution system and automatic execution method of the orchard spraying robot whose publication number is CN107544511A. Both of them set prerequisites for the autonomous travel of the robot. The former needs to lay wires on the path, and the latter needs to set baffles on the edge of the path, which are not operable in actual production. Chinese patent application publication number is a kind of intelligent spraying robot of CN106719544A, is only suitable for field spraying, and has no navigation function. Chinese patent application publication number is CN108391649A a kind of orchard automatic spraying device, needs to lay track in the field in advance, and the one, it is comparatively loaded down with trivial details to implement, and investment is bigger;
实用新型内容Utility model content
针对现有技术的不足,本实用新型提供一种用于果园作业的自主导航喷药机器人。Aiming at the deficiencies of the prior art, the utility model provides an autonomous navigation spraying robot for orchard operations.
本实用新型采用以下技术方案:The utility model adopts the following technical solutions:
一方面,本实用新型提供一种用于果园作业的自主导航喷药机器人,包括机器人本体和附属设备;On the one hand, the utility model provides an autonomous navigation spraying robot for orchard operations, including a robot body and auxiliary equipment;
所述机器人本体包括移动式底盘,以及设置于移动式底盘上的风送喷药装置、惯性导航装置、卫星定位装置、控制系统、远程通信装置和为喷药机器人提供动力的能源动力系统,所述机器人本体的前后端均设置有雷达避障装置;所述附属设备包括遥控器和通讯基站;The robot body includes a mobile chassis, and an air-driven spraying device, an inertial navigation device, a satellite positioning device, a control system, a remote communication device, and an energy power system that provides power for the spraying robot are arranged on the mobile chassis. The front and rear ends of the robot body are equipped with radar obstacle avoidance devices; the accessory equipment includes a remote controller and a communication base station;
所述风送喷药装置、惯性导航装置、卫星定位装置、能源动力系统和雷达避障装置均与所述控制系统连接,所述控制系统连接所述移动式底盘来控制移动式底盘的前进、后退、转向、加速、减速和停止;控制系统接收和处理来自卫星定位装置、惯性导航装置等发来的数据,实现机器人的驱动控制、路径学习、自主导航、喷药控制、远程通信等功能,通过控制系统实现上述功能均可采用现有的成熟技术实现,此处不作过多陈述。The wind-driven spraying device, inertial navigation device, satellite positioning device, energy power system and radar obstacle avoidance device are all connected to the control system, and the control system is connected to the mobile chassis to control the advancement of the mobile chassis, Reverse, turn, accelerate, decelerate and stop; the control system receives and processes data from satellite positioning devices, inertial navigation devices, etc., to realize the functions of robot drive control, path learning, autonomous navigation, spraying control, and remote communication. The above-mentioned functions can be realized by using the existing mature technology through the control system, and too many statements are not made here.
所述控制系统与所述远程通信装置连接,所述远程通讯装置通过通讯基站连接互联网,所述远程通讯装置还通过无线连接所述遥控器。The control system is connected to the remote communication device, the remote communication device is connected to the Internet through a communication base station, and the remote communication device is also connected to the remote controller through wireless.
优选的,所述机器人本体还包括状态感知系统,所述状态感知系统包括位于所述风送喷药装置的液位传感器,位于能源动力系统的电量传感器,位于惯性导航装置的速度和航向传感器,位于卫星定位装置的位置传感器,以及位于机器人上的摄像头等,用于实时感知药液量、电量、位置、速度、航向及视频等,并可实现远传,状态感知系统的各个传感器均连接至所述控制系统,上述各个传感器的型号可根据实际情况灵活选择,均不影响本实用新型的实施。Preferably, the robot body also includes a state sensing system, the state sensing system includes a liquid level sensor located in the air-driven spraying device, a power sensor located in the energy power system, a speed and heading sensor located in the inertial navigation device, The position sensor located on the satellite positioning device and the camera located on the robot are used for real-time perception of liquid medicine volume, power, position, speed, heading and video, etc., and can realize remote transmission. Each sensor of the state perception system is connected to Described control system, the model of above-mentioned each sensor can be selected flexibly according to actual situation, all does not influence implementation of the present utility model.
优选的,所述移动式底盘为轮式底盘或履带式底盘,机器人采用轮式或履带式底盘作为载体和移动平台。Preferably, the mobile chassis is a wheeled chassis or a crawler chassis, and the robot uses a wheeled or crawler chassis as a carrier and a mobile platform.
优选的,所述通讯基站为塔式基站,最好设置于果园的几何中心区域,通讯基站为固定设施,一次建立长期使用,通讯基站包括固定底座和立杆支架,所述立杆支架上安装有无线网桥、通信天线、电台天线、卫星天线等通信设备,信号覆盖果园范围;喷药机器人的状态感知系统会将自身的相关信息如药液量、电量、位置、速度及视频图像等通过通讯基站传送至遥控器及互联网;喷药机器人可接收遥控器或远程互联网端的控制指令并执行相应任务,实现人对喷药机器人手动遥控或远程控制。Preferably, the communication base station is a tower base station, preferably arranged in the geometric center area of the orchard, the communication base station is a fixed facility, once established for long-term use, the communication base station includes a fixed base and a pole bracket, and the pole bracket is installed There are wireless bridges, communication antennas, radio antennas, satellite antennas and other communication equipment, and the signal covers the range of the orchard; the state perception system of the spraying robot will pass its own relevant information such as the amount of liquid medicine, power, position, speed and video images, etc. The communication base station transmits to the remote control and the Internet; the spraying robot can receive control commands from the remote control or the remote Internet terminal and perform corresponding tasks, realizing manual or remote control of the spraying robot by humans.
优选的,所述风送喷药装置采用集成式多喷头风送喷药装置,所述集成式多喷头风送喷药装置包括药液箱、柱塞泵、多个喷头和风机,所述药液箱通过出水管与多个喷头连接。Preferably, the air-driven spraying device adopts an integrated multi-nozzle air-driven spraying device, and the integrated multi-nozzle air-driven spraying device includes a liquid medicine tank, a plunger pump, a plurality of spray heads and a fan. The liquid tank is connected with a plurality of spray heads through the outlet pipe.
喷雾时,药液箱内的药液在柱塞泵的作用下具有一定的压力,经出水管通过多个喷头以雾状喷出,并通过风机强大气流,将雾滴再次进行雾化,同时将雾化后的细雾滴送到果树的树冠内,风机优选为电动风机,强化喷药距离和雾化效果。When spraying, the liquid medicine in the liquid medicine tank has a certain pressure under the action of the plunger pump, and it is sprayed out in the form of mist through multiple nozzles through the outlet pipe, and the spray is atomized again by the strong airflow of the fan, and at the same time The atomized fine mist is sent to the canopy of the fruit tree, and the fan is preferably an electric fan to enhance the spraying distance and atomization effect.
优选的,所述惯性导航装置包括MEMS陀螺仪和处理器,所述处理器与所述控制系统连接,所述处理器为STM32微处理器,用于对MEMS陀螺仪发出的信号进行处理并传递至控制系统。惯性导航装置可以确保机器人在果园内因树冠遮挡等导致间歇性卫星失联时也能正常导航行走。Preferably, the inertial navigation device includes a MEMS gyroscope and a processor, the processor is connected to the control system, and the processor is an STM32 microprocessor, which is used to process and transmit the signal sent by the MEMS gyroscope to the control system. The inertial navigation device can ensure that the robot can navigate and walk normally when intermittent satellites lose contact due to tree canopy occlusion in the orchard.
所述惯性导航装置的型号优选为北京航天军创JCG-ZCR-G4A2-J12型惯导模块。The model of the inertial navigation device is preferably a JCG-ZCR-G4A2-J12 inertial navigation module created by Beijing Aerospace Army.
优选的,所述卫星定位装置采用GPS接收机或北斗卫星接收机,并配备有双卫星天线和卫星定位基站,实现高精度差分定位;双卫星天线用于接收导航定位卫星的定位信号,GPS接收机或北斗卫星接收机用于处理收到的定位信号,并解算出位置坐标。Preferably, the satellite positioning device adopts a GPS receiver or a Beidou satellite receiver, and is equipped with dual satellite antennas and satellite positioning base stations to achieve high-precision differential positioning; the dual satellite antennas are used to receive positioning signals from navigation and positioning satellites, and GPS receives The computer or Beidou satellite receiver is used to process the received positioning signal and solve the position coordinates.
优选的,所述卫星定位装置中,通讯基站接收机型号为上海司南M300,移动端接收机型号为上海司南M600U,卫星天线型号为上海司南AT340。Preferably, in the satellite positioning device, the model of the communication base station receiver is Shanghai Sinan M300, the model of the mobile terminal receiver is Shanghai Sinan M600U, and the model of the satellite antenna is Shanghai Sinan AT340.
优选的,所述能源动力系统包括发电机、蓄电池和电机等,为机器人提供能源和动力。Preferably, the energy power system includes generators, storage batteries, motors, etc., to provide energy and power for the robot.
优选的,所述雷达避障装置包括超声波传感器和超声波控制器,所述超声波传感器设置于喷药机器人的前后端位置以辅助避障,所述超声波传感器包括发射单元和接收单元,分别用于发射和接收超声波,所述超声波控制器与所述超声波传感器连接,依据发射超声波与接收超声波之间的时间差,计算机器人于障碍物之间的距离,所述超声波控制器与所述控制系统连接。Preferably, the radar obstacle avoidance device includes an ultrasonic sensor and an ultrasonic controller, the ultrasonic sensor is arranged at the front and rear ends of the spraying robot to assist obstacle avoidance, and the ultrasonic sensor includes a transmitting unit and a receiving unit, respectively for transmitting and receiving ultrasonic waves, the ultrasonic controller is connected with the ultrasonic sensor, and the distance between the robot and the obstacle is calculated according to the time difference between transmitting ultrasonic waves and receiving ultrasonic waves, and the ultrasonic controller is connected with the control system.
所述雷达避障装置的型号优选为HC-SR04。The model of the radar obstacle avoidance device is preferably HC-SR04.
优选的,所述远程通信装置采用5.8G无线网桥并配置360度高增益全向天线,喷药机器人作为远程通信的移动端,通讯基站作为远程通讯的固定端。Preferably, the remote communication device adopts a 5.8G wireless network bridge and is equipped with a 360-degree high-gain omnidirectional antenna, the spraying robot is used as a mobile terminal for remote communication, and the communication base station is used as a fixed terminal for remote communication.
进一步优选的,所述控制系统采用树莓派或ARM嵌入式系统作为处理平台,使用Python及C/C++等编写控制程序,接收和处理来自卫星定位装置、惯性导航装置等发来的数据,实现机器人的驱动控制、路径学习、自主导航、喷药控制、状态感知、远程通信等功能。Further preferably, the control system adopts a raspberry pie or an ARM embedded system as a processing platform, uses Python and C/C++ etc. to write a control program, receives and processes data sent from a satellite positioning device, an inertial navigation device, etc., and realizes Robot drive control, path learning, autonomous navigation, spraying control, state perception, remote communication and other functions.
所述控制系统优选采用ARM Cortex-A53及以上处理器。The control system preferably adopts ARM Cortex-A53 and above processors.
进一步优选的,所述遥控器包括左摇杆、右摇杆、天线、显示屏和模式选择按钮。Further preferably, the remote controller includes a left joystick, a right joystick, an antenna, a display screen and a mode selection button.
另一方面,本实用新型提供一种用于果园作业的自主导航喷药机器人的工作方法,包括遥控模式、学习模式和导航模式,其中:On the other hand, the utility model provides a working method of an autonomous navigation spraying robot for orchard operations, including a remote control mode, a learning mode and a navigation mode, wherein:
喷药机器人在初次加电或自其他模式退出后均默认处于遥控模式,在该模式下,喷药机器人依靠人控制遥控器来控制行走,如前进、左转、右转、后退、加速、减速、停止;The spraying robot is in the remote control mode by default when it is powered on for the first time or exits from other modes. In this mode, the spraying robot relies on the human to control the remote control to control walking, such as forward, left, right, backward, acceleration, and deceleration ,stop;
喷药机器人进行导航模式前需先进行路径学习,路径学习过程为:人在遥控器上切换机器人为学习模式,通过遥控器控制机器人沿着目标路径走一遍,此过程中,控制系统内的存储器将路径记住,使机器人完成路径学习;Before the spraying robot enters the navigation mode, it needs to learn the path. The path learning process is as follows: the person switches the robot to the learning mode on the remote control, and controls the robot to walk along the target path through the remote control. During this process, the memory in the control system Remember the path to make the robot complete the path learning;
导航模式的工作过程为:人在遥控器上切换机器人为导航模式,并选择已学习过的路径,机器人即沿该路径自主导航行走,也就是说,对于同一段作业路径,机器人只是在第一次行走时需要进行路径学习,从第二次开始即可直接沿该路径自主导航。The working process of the navigation mode is: the human switches the robot to the navigation mode on the remote control, and selects a learned path, and the robot navigates and walks autonomously along the path. Path learning is required for the first time walking, and it can directly navigate along the path autonomously from the second time.
优选的,所述遥控模式下,人通过手持遥控器在视距范围内控制机器人的各种行为,首先使机器人行驶至目标作业区域,在遥控器上发送指令开启风送喷药装置,机器人开始工作并喷洒药液;人通过遥控器上的左右摇杆使机器人在果树行间行走,并控制机器人速度及方向;走完一行停止喷药,转向进入另一行并重复上述过程,实现机器人在遥控模式下的手动控制喷药;Preferably, in the remote control mode, people control the various behaviors of the robot within the sight range by holding the remote control. First, the robot is driven to the target operation area, and an instruction is sent on the remote control to turn on the air-driven spraying device, and the robot starts Work and spray the liquid medicine; people use the left and right joysticks on the remote control to make the robot walk between the rows of fruit trees, and control the speed and direction of the robot; stop spraying after walking one row, turn to another row and repeat the above process to realize the robot in the remote control Manually controlled spraying in mode;
所述学习模式下,人通过遥控器将机器人切换为学习模式,使机器人行驶至目标路径的起始点,选择学习键,机器人存储当前位置数据并反馈完成信号;使机器人继续行驶至下一目标地点,按下学习键,机器人存储该位置数据并反馈完成信号;重复上述过程,直至到达目标路径终点,机器人完成整条路径的学习并存储该路径的全部信息,在路径学习的过程中,机器人也可同步执行喷药作业;Under the learning mode, people switch the robot to the learning mode through the remote control, so that the robot travels to the starting point of the target path, selects the learning key, and the robot stores the current position data and feeds back a completion signal; the robot continues to drive to the next target location , press the learning button, the robot stores the position data and feeds back the completion signal; repeats the above process until it reaches the end of the target path, the robot completes the learning of the entire path and stores all the information of the path. During the path learning process, the robot also The spraying operation can be executed synchronously;
所述导航模式下,机器人行驶至目标路径的起始点或附近,人在遥控器上将机器人切换为导航模式,选择路径并开启导航,机器人加载学习过的路径信息并沿该路径自主导航行走,同时执行喷药作业,直至到达目标路径终点,机器人自动停止作业并返回遥控模式待命,在整个作业过程中可实现无人值守。In the navigation mode, the robot drives to the starting point or near the target path, and the person switches the robot to the navigation mode on the remote control, selects the path and starts the navigation, the robot loads the learned path information and autonomously navigates and walks along the path, At the same time, the spraying operation is carried out until the end of the target path is reached, the robot automatically stops the operation and returns to the remote control mode to stand by, and it can be unattended during the entire operation process.
本实用新型中,喷药机器人在自主导航模式下进行喷药作业,在作业过程中会将药液量等信息传送给遥控器;若药液量不足或低于预设数值时,机器人将自动停止作业并返回到遥控模式,同时向遥控器反馈报警信息请求添加药液;机器人在添加药液完毕后将首先导航至上次停止喷药的位置,再开始喷药作业,实现断点续喷。In the utility model, the spraying robot performs the spraying operation in the autonomous navigation mode, and will transmit information such as the amount of liquid medicine to the remote controller during the operation; if the amount of liquid medicine is insufficient or lower than the preset value, the robot will automatically Stop the operation and return to the remote control mode, and at the same time feed back the alarm information to the remote controller to request to add the liquid medicine; after adding the liquid medicine, the robot will first navigate to the position where the spraying was stopped last time, and then start the spraying operation to realize continuous spraying at breakpoints.
值得注意的是,在本实用新型中,喷药机器人进行路径学习的具体过程为:遥控器与机器人建立无线连接(无线连接方式包括但不限于蓝牙、wifi、zigbee、红外线等),在遥控器上将机器人切换为学习模式;机器人通过遥控器控制运行,到达学习位置后后静止;遥控器发送获取路径点坐标指令,机器人自动获取路径点定位坐标,并将信息返回遥控器;遥控器存储该信息并发出提示,此时一次采点工作完成;遥控机器人行至下一位置,重复上述步骤,直至运行完整个路径,并将路径信息存储在遥控器中,路径学习过程完成。It is worth noting that in the present utility model, the specific process of path learning for the spraying robot is: the remote controller establishes a wireless connection with the robot (wireless connection methods include but not limited to bluetooth, wifi, zigbee, infrared, etc.), Switch the robot to the learning mode; the robot runs under the control of the remote control, and stops after reaching the learning position; the remote control sends an instruction to obtain the coordinates of the way point, and the robot automatically obtains the positioning coordinates of the way point and returns the information to the remote control; the remote control stores the coordinates of the way point. At this time, the point collection work is completed; the remote control robot moves to the next position, repeats the above steps until the entire path is run, and the path information is stored in the remote control, and the path learning process is completed.
喷药机器人在学习模式下,对位置数据的存储是路径采集点坐标数据的存储;在控制系统作用下,机器人在相邻两个路径采集点之间沿直线行走;遥控器负责发送获取路径点坐标指令,接收机器人发来的相应数据并在遥控器上存储为路径文件;喷药机器人的卫星定位装置、控制系统、远程通信装置联合完成路径点坐标定位、采集和发送等工作。When the spraying robot is in the learning mode, the storage of position data is the storage of the coordinate data of the path collection points; under the action of the control system, the robot walks along a straight line between two adjacent path collection points; the remote control is responsible for sending and obtaining path points Coordinate command, receive the corresponding data sent by the robot and store it as a path file on the remote control; the satellite positioning device, control system, and remote communication device of the spraying robot jointly complete the coordinate positioning, collection and transmission of the path point.
在遥控器端选取要走的路径并下发给机器人(存于控制系统内),切换机器人工作模式为导航模式;然后遥控器发送开始导航指令,机器人接收到指令后即按下发的路径运行,机器人运行到路径最后一个采集点自动停止,自主导航结束。Select the path to go on the remote control and send it to the robot (stored in the control system), switch the working mode of the robot to navigation mode; then the remote control sends a command to start navigation, and the robot runs according to the route after receiving the command , the robot runs to the last collection point of the path and stops automatically, and the autonomous navigation ends.
本实用新型的有益效果为:The beneficial effects of the utility model are:
与现有技术相比,本实用新型提供了一种用于果园作业的自主导航喷药机器人及其工作方法。在喷药方面,机器人采用集成式多喷头风送喷药装置,喷药距离远,雾化程度高,树冠穿透效果好,果树受药均匀;在导航定位方面,本实用新型采用卫星定位装置与惯导导航装置相结合,集前者的高精度和后者的稳定性等优点于一体,实现组合式导航,使机器人在果园内因树冠遮挡等导致间歇性卫星失联时也能正常导航和行走;在作业方面,机器人具有状态感知和智能控制等功能,可实现对靶喷药、断点续喷和夜间作业。Compared with the prior art, the utility model provides an autonomous navigation spraying robot for orchard operations and a working method thereof. In terms of spraying, the robot adopts an integrated multi-nozzle air-supply spraying device, which has a long spraying distance, a high degree of atomization, a good penetration effect of the tree canopy, and even fruit trees receive medicine; in terms of navigation and positioning, the utility model adopts a satellite positioning device Combined with the inertial navigation device, it integrates the advantages of the former's high precision and the latter's stability to realize combined navigation, so that the robot can navigate and walk normally when intermittent satellites are lost due to tree canopy occlusion in the orchard ; In terms of operation, the robot has the functions of state perception and intelligent control, which can realize target spraying, intermittent spraying and night operation.
通过本实用新型提供的喷药机器人及工作方法,能够显著降低果园喷药作业的用工数量和劳动强度,喷药精准、节药环保,且喷药机器人在弱光或夜间条件下作业时,其作业模式、效果均与白天作业相同,对于现代果业的提质增效和新旧动能转换具有重要意义。The spraying robot and working method provided by the utility model can significantly reduce the labor quantity and labor intensity of the spraying operation in the orchard. The operation mode and effect are the same as the daytime operation, which is of great significance for the improvement of quality and efficiency of modern fruit industry and the conversion of old and new kinetic energy.
附图说明Description of drawings
图1为本实用新型的用于果园作业的自主导航喷药机器人一种实施例的结构示意图;Fig. 1 is a structural schematic diagram of an embodiment of an autonomous navigation spraying robot for orchard operations of the present invention;
图2为本实用新型的遥控器的一种实施例的结构示意图;Fig. 2 is a schematic structural view of an embodiment of the remote controller of the present invention;
图3为本实用新型的通讯基站的结构示意图;Fig. 3 is the structural representation of the communication base station of the present utility model;
图4为本实用新型的控制系统的连接关系示意图;Fig. 4 is a schematic diagram of the connection relationship of the control system of the present invention;
其中:1.移动式底盘,2.风送喷药装置,3.惯性导航装置,4.卫星定位装置,5.控制系统,6.远程通讯装置,7.能源动力系统,8.雷达避障装置,9.遥控器,9-1.左摇杆、9-2.右摇杆,9-3.天线,9-4.显示器,10.通讯基站,10-1.固定底座,10-2.立杆支架,10-3.无线网桥,10-4.通讯天线,10-5.电台天线,10-6.卫星天线,11.状态感知系统。Among them: 1. Mobile chassis, 2. Wind spraying device, 3. Inertial navigation device, 4. Satellite positioning device, 5. Control system, 6. Remote communication device, 7. Energy power system, 8. Radar obstacle avoidance Device, 9. Remote control, 9-1. Left joystick, 9-2. Right joystick, 9-3. Antenna, 9-4. Display, 10. Communication base station, 10-1. Fixed base, 10-2 .Pole support, 10-3. Wireless bridge, 10-4. Communication antenna, 10-5. Radio antenna, 10-6. Satellite antenna, 11. Status awareness system.
具体实施方式Detailed ways
为使本实用新型要解决的技术问题、技术方案和优点更加清楚,下面将结合附图及具体实施例进行详细描述,但不仅限于此,本实用新型未详尽说明的,均按本领域常规技术。In order to make the technical problems, technical solutions and advantages to be solved by the utility model more clear, the following will be described in detail in conjunction with the accompanying drawings and specific embodiments, but not limited thereto, the utility model is not described in detail, all according to the conventional technology in the field .
实施例1:Example 1:
如图1-4所示,一种用于果园作业的自主导航喷药机器人,包括机器人本体和附属设备;As shown in Figure 1-4, an autonomous navigation spraying robot for orchard operations, including the robot body and auxiliary equipment;
机器人本体包括移动式底盘1,以及设置于移动式底盘1上的风送喷药装置2、惯性导航装置3、卫星定位装置4、控制系统5、远程通信装置6和为喷药机器人提供动力的能源动力系统7,机器人本体的前后端均设置有雷达避障装置8;所述附属设备包括遥控器9和通讯基站10;The robot body includes a mobile chassis 1, and an air-driven spraying device 2, an inertial navigation device 3, a satellite positioning device 4, a control system 5, a remote communication device 6 and a power supply for the spraying robot provided on the mobile chassis 1. The energy power system 7, the front and rear ends of the robot body are equipped with a radar obstacle avoidance device 8; the auxiliary equipment includes a remote controller 9 and a communication base station 10;
风送喷药装置2、惯性导航装置3、卫星定位装置4、能源动力系统7和雷达避障装置8均与控制系统5连接,控制系统5连接移动式底盘1来控制移动式底盘1的前进、后退、转向、加速、减速和停止;控制系统5接收和处理来自卫星定位装置4、惯性导航装置3等发来的数据,实现机器人的驱动控制、路径学习、自主导航、喷药控制、远程通信等功能。The air-driven spraying device 2, the inertial navigation device 3, the satellite positioning device 4, the energy power system 7 and the radar obstacle avoidance device 8 are all connected to the control system 5, and the control system 5 is connected to the mobile chassis 1 to control the advancement of the mobile chassis 1 , back, turn, acceleration, deceleration and stop; the control system 5 receives and processes the data sent from the satellite positioning device 4, the inertial navigation device 3, etc., and realizes the drive control, path learning, autonomous navigation, spraying control, remote Communication and other functions.
控制系统5与远程通信装置6连接,远程通讯装置6通过通讯基站10连接互联网,远程通讯装置6还通过无线连接遥控器9。The control system 5 is connected with the remote communication device 6, and the remote communication device 6 is connected to the Internet through the communication base station 10, and the remote communication device 6 is also connected with the remote controller 9 through wireless.
实施例2:Example 2:
一种用于果园作业的自主导航喷药机器人,结构如实施例1所示,所不同的是,机器人本体还包括状态感知系统11,状态感知系统11包括位于风送喷药装置2的液位传感器,位于能源动力系统7的电量传感器,位于惯性导航装置3的速度和航向传感器,位于卫星定位装置4的位置传感器,以及位于机器人上的摄像头等均连接至控制系统5,用于实时感知药液量、电量、位置、速度、航向及视频等,并可通过远程通讯装置6实现远传。An autonomous navigation spraying robot for orchard operations, the structure is as shown in Embodiment 1, the difference is that the robot body also includes a state sensing system 11, and the state sensing system 11 includes a liquid level sensor located in the air-driven spraying device 2. Sensors, the power sensor located in the energy power system 7, the speed and heading sensor located in the inertial navigation device 3, the position sensor located in the satellite positioning device 4, and the camera located on the robot etc. are all connected to the control system 5 for real-time sensing medicine. Fluid volume, electric quantity, position, speed, course and video etc., and can realize remote transmission through telecommunication device 6.
实施例3:Example 3:
一种用于果园作业的自主导航喷药机器人,如实施例1所示,所不同的是,移动式底盘1为轮式底盘或履带式底盘,机器人采用轮式或履带式底盘作为载体和移动平台。An autonomous navigation spraying robot for orchard operations, as shown in Embodiment 1, the difference is that the mobile chassis 1 is a wheeled chassis or a crawler chassis, and the robot uses a wheeled or crawler chassis as a carrier and mobile platform.
实施例4:Example 4:
一种用于果园作业的自主导航喷药机器人,如实施例1所示,所不同的是,如图3所示,通讯基站10为塔式基站,设置于果园的几何中心区域,通讯基站10为固定设施,一次建立长期使用,通讯基站10包括固定底座10-1和立杆支架10-2,立杆支架10-2上安装有无线网桥10-3、通信天线10-4、电台天线10-5、卫星天线10-6等通信设备,信号覆盖果园范围;喷药机器人的状态感知系统11会将自身的相关信息如药液量、电量、位置、速度及视频图像等通过通讯基站10传送至遥控器9及互联网;喷药机器人可接收遥控器9或远程互联网端的控制指令并执行相应任务,实现人对喷药机器人手动遥控或远程控制。An autonomous navigation spraying robot for orchard operations, as shown in Embodiment 1, the difference is that, as shown in Figure 3, the communication base station 10 is a tower base station, which is arranged in the geometric center area of the orchard, and the communication base station 10 As a fixed facility, once established for long-term use, the communication base station 10 includes a fixed base 10-1 and a pole support 10-2, and a wireless network bridge 10-3, a communication antenna 10-4, and a radio antenna are installed on the pole support 10-2 10-5, satellite antenna 10-6 and other communication equipment, the signal covers the range of the orchard; the state perception system 11 of the spraying robot will pass its own relevant information such as the amount of liquid medicine, power, position, speed and video images through the communication base station 10 Send to the remote control 9 and the Internet; the spraying robot can receive the control instructions from the remote control 9 or the remote Internet terminal and perform corresponding tasks, so as to realize the manual remote control or remote control of the spraying robot by humans.
实施例5:Example 5:
一种用于果园作业的自主导航喷药机器人,如实施例4所示,所不同的是,风送喷药装置2采用集成式多喷头风送喷药装置,集成式多喷头风送喷药装置包括药液箱、柱塞泵、多个喷头和风机,所述药液箱通过出水管与多个喷头连接。An autonomous navigation spraying robot for orchard operations, as shown in Embodiment 4, the difference is that the air-sent spraying device 2 adopts an integrated multi-nozzle air-sent spraying device, and the integrated multi-nozzle air-sent spraying device The device includes a liquid medicine tank, a plunger pump, multiple spray heads and a blower fan, and the liquid medicine tank is connected with the multiple spray heads through an outlet pipe.
喷雾时,药液箱内的药液在柱塞泵的作用下具有一定的压力,经出水管通过多个喷头以雾状喷出,并通过风机强大气流,将雾滴再次进行雾化,同时将雾化后的细雾滴送到果树的树冠内,风机为电动风机,强化喷药距离和雾化效果。When spraying, the liquid medicine in the liquid medicine tank has a certain pressure under the action of the plunger pump, and it is sprayed out in the form of mist through multiple nozzles through the outlet pipe, and the spray is atomized again by the strong airflow of the fan, and at the same time The atomized fine mist is sent to the canopy of the fruit tree, and the fan is an electric fan to enhance the spraying distance and atomization effect.
实施例6:Embodiment 6:
一种用于果园作业的自主导航喷药机器人,如实施例1所示,所不同的是,惯性导航装置3包括MEMS陀螺仪和处理器,处理器与控制系统5连接,处理器为STM32微处理器,用于对MEMS陀螺仪发出的信号进行处理并传递至控制系统5。惯性导航装置可以确保机器人在果园内因树冠遮挡等导致间歇性卫星失联时也能正常导航行走。A self-guided spraying robot for orchard operations, as shown in Embodiment 1, the difference is that the inertial navigation device 3 includes a MEMS gyroscope and a processor, the processor is connected to the control system 5, and the processor is an STM32 micro The processor is used to process the signal sent by the MEMS gyroscope and transmit it to the control system 5 . The inertial navigation device can ensure that the robot can navigate and walk normally when intermittent satellites lose contact due to tree canopy occlusion in the orchard.
实施例7:Embodiment 7:
一种用于果园作业的自主导航喷药机器人,如实施例1所示,所不同的是,卫星定位装置4采用GPS接收机,并配备有双卫星天线和卫星定位基站,实现高精度差分定位;双卫星天线用于接收导航定位卫星的定位信号,GPS接收机用于处理收到的定位信号,并解算出位置坐标。An autonomous navigation spraying robot for orchard operations, as shown in Embodiment 1, the difference is that the satellite positioning device 4 uses a GPS receiver, and is equipped with dual satellite antennas and satellite positioning base stations to achieve high-precision differential positioning ; The dual satellite antennas are used to receive positioning signals from navigation and positioning satellites, and the GPS receiver is used to process the received positioning signals and calculate the position coordinates.
实施例8:Embodiment 8:
一种用于果园作业的自主导航喷药机器人,如实施例1所示,所不同的是,雷达避障装置8包括超声波传感器和超声波控制器,超声波传感器设置于喷药机器人的前后端位置以辅助避障,超声波传感器包括发射单元和接收单元,分别用于发射和接收超声波,超声波控制器与超声波传感器连接,依据发射超声波与接收超声波之间的时间差,计算机器人于障碍物之间的距离,超声波控制器与控制系统5连接。An autonomous navigation spraying robot for orchard operations, as shown in Embodiment 1, the difference is that the radar obstacle avoidance device 8 includes an ultrasonic sensor and an ultrasonic controller, and the ultrasonic sensor is arranged at the front and rear ends of the spraying robot to Auxiliary obstacle avoidance, the ultrasonic sensor includes a transmitting unit and a receiving unit, which are used to transmit and receive ultrasonic waves respectively. The ultrasonic controller is connected to the ultrasonic sensor, and the distance between the robot and the obstacle is calculated according to the time difference between transmitting ultrasonic waves and receiving ultrasonic waves. The ultrasonic controller is connected with the control system 5 .
实施例9:Embodiment 9:
一种用于果园作业的自主导航喷药机器人,如实施例1所示,所不同的是,远程通信装置6采用5.8G无线网桥并配置360度高增益全向天线,喷药机器人作为远程通信的移动端,通讯基站10作为远程通讯的固定端;An autonomous navigation spraying robot for orchard operations, as shown in Embodiment 1, the difference is that the remote communication device 6 adopts a 5.8G wireless bridge and is configured with a 360-degree high-gain omnidirectional antenna, and the spraying robot is used as a remote The mobile end of the communication, the communication base station 10 is used as the fixed end of the long-distance communication;
控制系统5采用ARM Cortex-A53处理器,使用Python及C/C++等编写控制程序,接收和处理来自卫星定位装置、惯性导航装置等发来的数据,实现机器人的驱动控制、路径学习、自主导航、喷药控制、状态感知、远程通信等功能。Control system 5 adopts ARM Cortex-A53 processor, uses Python and C/C++ to write control programs, receives and processes data from satellite positioning devices, inertial navigation devices, etc., and realizes robot drive control, path learning, and autonomous navigation , spraying control, state perception, remote communication and other functions.
如图2所示,遥控器9包括左摇杆9-1、右摇杆9-2、天线9-3、显示屏9-4和模式选择按钮。As shown in FIG. 2 , the remote controller 9 includes a left stick 9-1, a right stick 9-2, an antenna 9-3, a display screen 9-4 and a mode selection button.
以上所述是本实用新型的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本实用新型所述原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本实用新型的保护范围。The above is a preferred embodiment of the utility model, it should be pointed out that for those of ordinary skill in the art, without departing from the principle of the utility model, some improvements and modifications can also be made. And retouching should also be regarded as the protection scope of the present utility model.
Claims (10)
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201821742304 | 2018-10-26 | ||
| CN2018217423045 | 2018-10-26 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN209862068U true CN209862068U (en) | 2019-12-31 |
Family
ID=68959953
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201920506063.2U Expired - Fee Related CN209862068U (en) | 2018-10-26 | 2019-04-15 | An autonomous navigation spraying robot for orchard operations |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN209862068U (en) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111292519A (en) * | 2020-04-14 | 2020-06-16 | 智动时代(北京)科技有限公司 | Multi-mode interactive intelligent remote control system |
| CN113799129A (en) * | 2021-09-17 | 2021-12-17 | 吉林省农业机械研究院 | An intelligent obstacle avoidance control system for the robotic arm of a spray-rod sprayer |
| CN115868470A (en) * | 2022-12-15 | 2023-03-31 | 内蒙古民族大学 | A sunflower spraying robot |
-
2019
- 2019-04-15 CN CN201920506063.2U patent/CN209862068U/en not_active Expired - Fee Related
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111292519A (en) * | 2020-04-14 | 2020-06-16 | 智动时代(北京)科技有限公司 | Multi-mode interactive intelligent remote control system |
| CN113799129A (en) * | 2021-09-17 | 2021-12-17 | 吉林省农业机械研究院 | An intelligent obstacle avoidance control system for the robotic arm of a spray-rod sprayer |
| CN115868470A (en) * | 2022-12-15 | 2023-03-31 | 内蒙古民族大学 | A sunflower spraying robot |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109892311A (en) | A kind of independent navigation spray robot and its working method for orchard operation | |
| CN207665864U (en) | Unmanned plant protection robot | |
| CN209862068U (en) | An autonomous navigation spraying robot for orchard operations | |
| CN103340190B (en) | Orchard real-time spraying-feeding-maintaining multiple-robot system | |
| CN205594396U (en) | Pesticide sprays unmanned aerial vehicle automatic control system | |
| CN205455559U (en) | Automatic spray formula agricultural unmanned aerial vehicle | |
| CN107021225A (en) | A kind of agriculture unmanned plane automatic spraying method and agriculture unmanned plane | |
| CN204837684U (en) | Big -arch shelter greenhouse plant protection equipment | |
| CN113057154A (en) | A greenhouse liquid spraying robot | |
| CN107678318A (en) | A kind of intelligence spray robot | |
| CN110825100A (en) | Plant protection fixed wing unmanned aerial vehicle autonomous take-off and landing control method | |
| CN112006004A (en) | Intelligent spraying trolley based on RTK-GPS high-precision positioning and control method | |
| CN107450639A (en) | A kind of agricultural planting intellectualized management system | |
| CN211379379U (en) | Small automatic spray type forest nursery sprayer | |
| CN117562039A (en) | Frame construction connects accurate spraying robot in parallel | |
| CN208863429U (en) | A kind of intelligent robot for greenhouse plant protection | |
| CN209749570U (en) | Orchard intelligence is from walking water-spraying system | |
| WO2015173825A1 (en) | Method and system for lawn care | |
| CN205461554U (en) | Intelligence environmental protection spray dust removal device | |
| CN113273557B (en) | A tethered unmanned aerial vehicle smoke agent spraying system and spraying method suitable for rubber trees | |
| WO2022183596A1 (en) | Air-blowing crop protection device | |
| KR20200057961A (en) | Unmanned Working apparatus by remote control | |
| CN208692137U (en) | A kind of intelligent distant control self-propelled sprayer promoting agricultural development | |
| CN207978792U (en) | A kind of guide tracked mechanical arm spraying system | |
| CN217011813U (en) | Grass cutter |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20191231 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |