CN114527727B - 一种自走式喷杆喷雾机及其无人驾驶控制***及方法 - Google Patents
一种自走式喷杆喷雾机及其无人驾驶控制***及方法 Download PDFInfo
- Publication number
- CN114527727B CN114527727B CN202210098231.5A CN202210098231A CN114527727B CN 114527727 B CN114527727 B CN 114527727B CN 202210098231 A CN202210098231 A CN 202210098231A CN 114527727 B CN114527727 B CN 114527727B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- control
- self
- boom sprayer
- control unit
- 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 18
- 238000005507 spraying Methods 0.000 claims abstract description 55
- 238000012544 monitoring process Methods 0.000 claims abstract description 32
- 238000004891 communication Methods 0.000 claims abstract description 28
- 238000007726 management method Methods 0.000 claims abstract description 9
- 238000012545 processing Methods 0.000 claims abstract description 5
- 238000013523 data management Methods 0.000 claims abstract description 4
- 239000007921 spray Substances 0.000 claims description 56
- 230000001276 controlling effect Effects 0.000 claims description 21
- 239000003814 drug Substances 0.000 claims description 11
- 239000000575 pesticide Substances 0.000 claims description 9
- 230000003993 interaction Effects 0.000 claims description 7
- 239000007788 liquid Substances 0.000 claims description 7
- 238000005259 measurement Methods 0.000 claims description 7
- 230000001105 regulatory effect Effects 0.000 claims description 7
- 230000008569 process Effects 0.000 claims description 5
- 238000013459 approach Methods 0.000 claims description 3
- 230000006835 compression Effects 0.000 claims description 3
- 238000007906 compression Methods 0.000 claims description 3
- 238000000605 extraction Methods 0.000 claims description 3
- 238000013439 planning Methods 0.000 claims description 2
- 239000007858 starting material Substances 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 8
- 230000009471 action Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000010705 motor oil Substances 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
- 238000003079 width control Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
- G05B23/0205—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
- G05B23/0208—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterized by the configuration of the monitoring system
- G05B23/0213—Modular or universal configuration of the monitoring system, e.g. monitoring system having modules that may be combined to build monitoring program; monitoring system that can be applied to legacy systems; adaptable monitoring system; using different communication protocols
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01M—CATCHING, TRAPPING OR SCARING OF ANIMALS; APPARATUS FOR THE DESTRUCTION OF NOXIOUS ANIMALS OR NOXIOUS PLANTS
- A01M7/00—Special adaptations or arrangements of liquid-spraying apparatus for purposes covered by this subclass
- A01M7/0089—Regulating or controlling systems
-
- 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
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Life Sciences & Earth Sciences (AREA)
- Engineering & Computer Science (AREA)
- Insects & Arthropods (AREA)
- Pest Control & Pesticides (AREA)
- Wood Science & Technology (AREA)
- Zoology (AREA)
- Environmental Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Catching Or Destruction (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种自走式喷杆喷雾机及其无人驾驶控制***及方法,该自走式喷杆喷雾机包括无人驾驶控制***,该***用于基于作物行自动对行的无人航迹跟踪和变量喷药控制,包括车载平台,可离线运行或在线运行,进行自走式喷杆喷雾机的控制或状态监控;远端平台,安装有基于GIS组件的远程作业管理***,通过通信网络与车载平台通信,用于生成GIS作业地图、变量喷雾作业管理、农机作业参数设置、农机实时监控与作业轨迹显示、远程启停及作业控制、历史作业数据管理及无线通信处理;以及客户端,用于自走式喷杆喷雾机的遥控手动作业控制,并实时接收车载平台的网络视频监控信息。本发明还提供了该自走式喷杆喷雾机的无人驾驶控制方法。
Description
技术领域
本发明涉及一种喷杆喷雾机及其控制***,特别是一种全液压自走式喷杆喷雾机及其无人驾驶控制***及方法。
背景技术
无人驾驶技术首先与拖拉机结合实现了耕种的无人化作业,但对于田间管理,尤其是自走式喷杆喷雾机的植保作业,由于作业场景较为复杂、要求作业速度较高,还处在辅助自动驾驶阶段,尚未实现完全的无人驾驶、无人作业。
发明内容
本发明所要解决的技术问题是针对现有技术的上述缺陷,提供一种自走式喷杆喷雾机及其无人驾驶控制***及方法。
为了实现上述目的,本发明提供了一种自走式喷杆喷雾机的无人驾驶控制***,其中,用于自走式喷杆喷雾机基于作物行自动对行的无人航迹跟踪和变量喷药控制,所述无人驾驶控制***包括:
车载平台,安装在自走式喷杆喷雾机上,所述车载平台可离线运行或在线运行,进行所述自走式喷杆喷雾机的控制或状态监控,所述车载平台包括无线路由器、车载终端、ADCU自动驾驶控制单元、INS组合惯导***、发动机ECU单元、VCU整车控制单元、VSCU变量喷雾控制单元和RVMU网络视频监控单元,所述车载终端分别与所述ADCU自动驾驶控制单元、INS组合惯导***、发动机ECU、VCU整车控制单元、VSCU变量喷雾控制单元和RVMU网络视频监控单元连接;
远端平台,安装有基于GIS组件的远程作业管理***,通过通信网络与所述车载平台通信,用于生成GIS作业地图、变量喷雾作业管理、农机作业参数设置、农机实时监控与作业轨迹显示、远程启停及作业控制、历史作业数据管理及无线通信处理;以及
客户端,用于所述自走式喷杆喷雾机的遥控手动作业控制,并实时接收所述车载平台的网络视频监控信息;
其中,所述无线路由器为集成4G/5G网络模块和多个以太网接口的工业级无线路由器,与所述车载终端、所述ADCU自动驾驶控制单元和所述RVMU网络视频监控单元连接,实现本地高速网络通信;同时通过所述4G/5G网络模块对本地数据进行转发,实现与所述远端平台和所述客户端的无线网络交互。
上述的自走式喷杆喷雾机的无人驾驶控制***,其中,所述远端平台通信交互的作业参数、轨迹点数据和视频监控数据可选择性切换使用,以节约数据流量资源。
上述的自走式喷杆喷雾机的无人驾驶控制***,其中,所述车载终端为嵌入式PC终端,包含CAN总线、以太网和RS232通信接口,用以支持连接不同的控制单元;在线工作时,所述车载终端通过以太网接收并解析来自所述远端平台或所述APP客户端的命令数据,并通过所述CAN总线分发给所述VSCU变量喷雾控制单元、所述VCU整车控制单元和所述ADCU自动驾驶控制单元;离线工作时,通过所述车载终端的触摸屏监控车辆状态和设置车辆参数,以U盘导入作业计划并对所述作业计划进行分解,发送相应命令给相关控制单元实现变量喷雾控制、喷杆控制、车速控制、灯光控制、导航定位与轨迹跟踪、作物行对行控制和地头转弯掉头。
上述的自走式喷杆喷雾机的无人驾驶控制***,其中,所述RVMU网络视频监控单元包括多个车载网络摄像头,所述车载网络摄像头支持H.264和H.265压缩格式,所述远端平台可通过网络访问所述车载网络摄像头的视频数据,对所述自走式喷杆喷雾机的作业环境和作业状态进行监控。
上述的自走式喷杆喷雾机的无人驾驶控制***,其中,所述VSCU变量喷雾控制单元包括喷雾主控制器、五路喷杆分段开关阀、喷雾压力传感器、喷雾流量传感器和电动调节阀,所述喷雾主控制器为车载控制器,集成有IO端口和CAN通讯端口,所述喷雾主控制器通过所述IO端口控制所述五路喷杆分段开关阀控制喷杆作业喷幅;并采集所述喷雾压力传感器和所述喷雾流量传感器的信号,根据车辆行驶速度信号生成控制输出信号驱动所述电动调节阀动作,实时对喷雾流量进行调节,实现基于作业速度的变量喷雾作业。
上述的自走式喷杆喷雾机的无人驾驶控制***,其中,所述VCU整车控制单元包括整车主控制器、喷杆控制阀组、行走控制阀组、轮距控制阀组、启动及ON档继电器、灯光继电器、行走液压***压力传感器和行走速度传感器,所述整车主控制器集成IO端口和至少2路CAN通讯端口,用于采集所述行走液压***压力传感器信号和行走速度传感器信号实时监测车辆行走***状态,所述整车主控制器所采集的信号均采用标准SAE J1939协议发送到CAN总线上,同时从所述CAN总线上获取并解析控制输出命令;所述喷杆控制阀组用于控制喷杆的折叠、展开和升降;所述行走控制阀组用于控制行走柱塞泵的电比例,实现所述自走式喷杆喷雾机的无极调速控制;所述轮距控制阀组用于作业轮距的调节;所述启动及ON档继电器用于控制发动机启动机的运转和发动机ECU的运行,实现发动机点火和熄火;所述灯光继电器用于控制远近光灯和工作灯。
上述的自走式喷杆喷雾机的无人驾驶控制***,其中,所述ADCU自动驾驶控制单元包括自动驾驶主控制器、激光雷达、转向角度传感器和转向电机,所述自动驾驶主控制器用于接收所述转向角度传感器和激光雷达的信息,对视域范围内的空间环境进行点云信息识别提取和三维重构建模,获得实时作业环境地图,识别作物行走行信息,融合高精度导航定位信息和机器姿态信息,并与预置的高精度作业地图数据进行比对,计算整机相对规划路径的偏离值,演算目标转向角度和转向速度,控制所述转向电机动作,实现无人对行行走。
上述的自走式喷杆喷雾机的无人驾驶控制***,其中,所述INS组合惯导***内置高精度定位模块、惯性测量单元和INS运算控制单元,所述高精度定位模块用于获取导航定位信息;所述惯性测量单元用于获取机器姿态信息;所述INS运算控制单元融合所述导航定位信息和机器姿态信息,并实时输出机器的姿态、方位、位置和速度数据。
为了更好地实现上述目的,本发明还提供了一种自走式喷杆喷雾机的无人驾驶控制方法,其中,包括:离线运行模式和在线运行模式;
所述离线运行模式时,包括如下步骤:
S101、车载终端从U盘获取GIS作业地图,解析出作业轨迹和作业边界,发送控制命令给VCU整车控制单元和ADCU自动驾驶控制单元,驱动自走式喷杆喷雾机寻找作业起始点;
S102、当到达作业起始点时自动展开喷杆,VSCU变量喷雾控制单元开启变量喷雾作业,ADCU自动驾驶控制单元控制所述自走式喷杆喷雾机沿规划的作业轨迹行走;
S103、当所述自走式喷杆喷雾机行走方向实时位置接近作业边界时,VCU整车控制单元控制所述自走式喷杆喷雾机自动减速,进入预掉头状态;
S104、到达所述作业边界时,控制所述自走式喷杆喷雾机掉头,所述ADCU自动驾驶控制单元获取下一作业行的位置坐标,并驱动所述自走式喷杆喷雾机寻找给定的作业行位置坐标,开始连续作业;以及
S105、作业过程中出现药液不足时,自动记忆当前作业位置坐标及返航轨迹并返回地头加药,加药完成后沿所述返航轨迹自动返回;
所述在线运行模式时,包括如下步骤:
S201、车载终端从网络获取GIS作业地图,同时从所述远端平台和APP客户端获取控制命令,并根据所述控制命令控制所述自走式喷杆喷雾机完成基于作物行自动对行的无人航迹跟踪和变量喷药控制;
S202、所述车载终端实时发送喷杆喷雾机作业状态信息,所述远端平台和客户端根据所述喷杆喷雾机作业状态信息实时监控机器状态;以及
S203、所述远端平台根据需要开启或关闭RVMU网络视频监控单元,以减少网络资源消耗。
为了更好地实现上述目的,本发明还提供了一种自走式喷杆喷雾机,其中,包括上述的无人驾驶控制***。
本发明的技术效果在于:
本发明设置有两种工作模式:离线模式和在线模式,可在网络信号弱或无网络信号时轻松切换,不影响正常作业;通过总线式模块结构加载各功能单元,实现了基于作物行自动对行的无人航迹跟踪和变量喷药控制。
以下结合附图和具体实施例对本发明进行详细描述,但不作为对本发明的限定。
附图说明
图1为本发明一实施例的无人驾驶控制***结构框图;
图2为本发明一实施例的VCU整车控制单元结构框图;
图3为本发明一实施例的VSCU变量喷雾控制单元结构框图;
图4为本发明一实施例的ADCU自动驾驶控制单元结构框图。
其中,附图标记
1客户端
2远端平台
3车载平台
31无线路由器
32车载终端
33VCU整车控制单元
331行走液压***压力传感器
332喷杆控制阀组
333行走控制阀组
334启动及ON档继电器
335轮距控制阀组
336灯光继电器
337整车主控制器
338行走速度传感器
34VSCU变量喷雾控制单元
341喷雾主控制器
342五路喷杆分段开关阀
343喷雾压力传感器
344喷雾流量传感器
345电动调节阀组
35发动机ECU
36INS组合惯导***
37ADCU自动驾驶控制单元
371自动驾驶主控制器
372激光雷达
373转向角度传感器
374转向电机
38RVMU网络视频监控单元
4通信网络
具体实施方式
下面结合附图对本发明的结构原理和工作原理作具体的描述:
参见图1,图1为本发明一实施例的无人驾驶控制***结构框图。本发明的自走式喷杆喷雾机的无人驾驶控制***包括客户端1、远端平台2和车载平台3,其中,所述客户端1可为安装于手机或平板电脑的客户端APP软件,作为远端平台软件的简化操作版本,用于自走式喷杆喷雾机的遥控手动作业控制(如车辆启停、喷药作业控制、转向及行走控制等),可根据需要实时接收所述车载平台的网络视频监控信息。所述远端平台2可为接入互联网的商业PC,安装有基于GIS组件开发的远程作业管理***,通过通信网络4如4G/5G网络与所述车载平台3通信,实现GIS建图、编辑、导入、导出等功能、变量喷雾作业管理(包括喷雾参数设置、喷雾作业控制、喷雾状态监控等)、农机作业参数设置、农机实时监控与作业轨迹显示、远程启停及作业控制、历史作业数据管理、无线通信处理等。通信交互的作业参数、轨迹点数据、视频监控数据等可根据用户实际需要选择性切换使用,以节约数据流量资源。
其中,车载平台3在无网络信号或网络信号弱的情况下可以独立离线工作,在网络信号正常时所述远端平台2和APP客户端1可正常连接所述车载平台接管车辆控制或监控车辆状态。所述车载平台3可包括无线路由器31、车载终端32、VCU整车控制单元33、VSCU变量喷雾控制单元34、发动机ECU35、INS组合惯导***36、ADCU自动驾驶控制单元37、和RVMU网络视频监控单元38。
本实施例的所述无线路由器31优选为集成4G/5G网络模块和3-4个以太网口的工业级无线路由器,与所述车载终端32、所述ADCU自动驾驶控制单元37和所述RVMU网络视频监控单元38通过以太网接口连接,实现本地高速网络通信;同时通过无线路由器的4G/5G网络模块对本地数据进行转发,实现与所述APP客户端1和所述远端平台2的无线网络数据交互。
本实施例的所述车载终端32优选为嵌入式PC终端,包含CAN、以太网、RS232等丰富的***通信接口,用以支持连接不同的控制单元。所述车载终端32通过高速CAN总线与各控制子单元连接,采用标准SAE J1939协议实现各控制子单元与车载终端32之间的信息共享;通过以太网口与所述无线路由器31相连,采用标准TCP IP协议实现与所述远端平台2、APP客户端1、RVMU网络视频监控单元38、ADCU自动驾驶控制单元37之间的信息交互。所述车载终端32作为所述车载平台2的控制中枢,在离线工作时,负责以U盘形式导入作业计划并对作业计划进行分解,发送相应命令给相关控制单元实现变量喷雾控制、喷杆控制、车速控制、灯光控制、导航定位与轨迹跟踪、作物行对行控制、地头转弯掉头等功能;在在线工作时,负责从网络接收命令数据和下载作业计划,经过解析后生成不同的控制命令分发给相应的控制单元。
所述发动机ECU单元35可为国三或国四发动机自带的用于控制发动机运转的专用控制器,优选为玉柴T300系列国三发动机自带的车载控制器,内置CAN接口,采用标准SAEJ1939协议实时输出发动机工作状态参数信息,如机油压力、水温、发动机转速等。
所述INS组合惯导***36基于MEMS技术开发,内置高精度定位模块、惯性测量单元以及INS运算控制单元,支持RTK通信和CAN通信。所述高精度定位模块优选为四频双模双天线卫星定位板卡,外置多星多频GNSS测量天线,同时可通过RTK通信实现高精度定位,定位精度可达cm级;所述惯性测量单元通过板载IMU获取机器翻滚角、俯仰角、方位角、三轴加速度和三轴角速度等机器姿态信息;INS运算控制单元融合导航定位信息和机器姿态信息,通过CAN总线实时输出机器的姿态、方位、位置、速度等传感器数据。
参见图2,图2为本发明一实施例的VCU整车控制单元33结构框图。本实施例中,所述VCU整车控制单元33为车辆控制中枢,用于实现自走式喷杆喷雾机的车速控制、轮距控制、车辆状态监测、灯光控制、启停控制以及喷杆的折叠、展开、升降等控制;同时采用标准SAE J1939协议实时将车辆状态信息、电液阀组控制状态信息、故障诊断信息发送到CAN总线上。该VCU整车控制单元33包括行走液压***压力传感器331、喷杆控制阀组332、行走控制阀组333、启动及ON档继电器334、轮距控制阀组335、灯光继电器336、整车主控制器337、行走速度传感器338组成。所述整车主控制器为专用车载控制器,集成丰富的IO端口和至少2路CAN通讯端口,支持二次开发,优选为RC28-14/30型车载控制器;所述行走液压***压力传感器331的量程为0-400bar,4-20mA输出;所述行走速度传感器338为NPN输出型接近开关。
所述整车主控制器337通过输入端口实时采集行走液压***压力传感器331和行走速度传感器338的信号,实时监测车辆行走液压***状态;通过输出端口驱动喷杆控制阀组332,实现喷杆的折叠、展开、升降等控制;通过驱动行走控制阀组333,实现行走柱塞泵的电比例控制,进而实现自走式喷杆喷雾机的无极调速控制;通过驱动轮距控制阀组335,实现作业轮距的调节,增强对不同种植模式的适应性;通过驱动启动及ON档继电器334,进而控制发动机启动机的运转和发动机ECU的运行,实现发动机点火和熄火控制;通过驱动灯光继电器336,实现对大功率远近光灯、工作灯等的控制。所述整车主控制器337的IO端口状态所采集的信号采用标准SAE J1939协议发送到CAN总线上,同时从总线上获取并解析控制输出命令以实现上述不同的功能。
参见图3,图3为本发明一实施例的VSCU变量喷雾控制单元34结构框图。本实施例中,所述VSCU变量喷雾控制单元34为植保作业的控制核心,从CAN总线上获取车辆作业行驶速度,并根据设定的每公顷目标施药量大小实时调节电动阀开度,进而对喷雾流量进行实时调节,实现基于作业速度的变量喷雾作业。该VSCU变量喷雾控制单元34包括喷雾主控制器341、五路喷杆分段开关阀342、喷雾压力传感器343、喷雾流量传感器344和电动调节阀组345。所述喷雾主控制器341为专用车载控制器,集成丰富的IO端口和CAN通讯端口,支持二次开发,优选为STW1412CMS型车载控制器,支持codesys2.3软件开发,支持H桥PWM驱动;喷雾压力传感器343量程为0-10bar,4-20mA输出;喷雾流量传感器344为方波脉冲输出;所述五路喷杆分段开关阀342将宽幅喷杆分段成5部分,通过开关不同的电动阀实现对不同喷杆区域的作业控制,主要用于作业地块边缘的喷杆喷幅控制;所述电动调节阀345内置直流电机驱动,其开度与管路流量的大小有关,通过所述喷雾主控制器341的H桥PWM驱动模块控制开度大小可实时调节管路流量。所述喷雾主控制器341读取所述喷雾压力传感器343和喷雾流量传感器344的信号,以每公顷施药量为控制目标,基于作业速度的变化经过运算处理后计算出控制输出信号,驱动所述电动调节阀345,对喷雾流量进行实时变量调节。
参见图4,图4为本发明一实施例的ADCU自动驾驶控制单元37结构框图。本实施例的所述ADCU自动驾驶控制单元37通过CAN总线获取所述INS组合惯导***36输出的机器姿态、方位等传感器数据,经过运算处理后输出控制命令,控制车辆转向机构动作,实现机器对导航轨迹的跟踪和对行作业。该ADCU自动驾驶控制单元37包括自动驾驶主控制器371、激光雷达372、转向角度传感器373和转向电机374。所述自动驾驶主控制器371将自动驾驶的自动感知、决策和控制集成到一个控制单元中,具备以下***接入能力:千兆以太网接入所述激光雷达372;多路CAN/CAN-FD,接入***总线中,以读取高精度导航定位信息和机器姿态信息;H桥PWM驱动模块,驱动所述转向电机374正反调速运转;1路模拟量输入端口,实时采集所述转向角度传感器373的信号。所述激光雷达372为混合激光雷达,优选为LivoxMid-70型激光雷达,点云输出速率达200000点/秒,以太网接口输出;所述转向角度传感器373安装在前转向桥上,测量转向机构转向角度,测量精度为0.1度,输出为4-20mA;所述转向电机为低速大扭矩直流电机,由所述自动驾驶主控制器371的H桥PWM输出模块驱动。所述自动驾驶主控制器371通过千兆以太网接收所述激光雷达372的信息,对视域范围内的空间环境进行点云信息识别提取和三维重构建模,获得实时作业环境地图,识别作物行走行信息,融合高精度导航定位信息和机器姿态信息,并与预置的高精度作业地图数据进行比对,计算机器相对规划路径的偏离值,演算目标转向角度和转向速度,控制转向电机动作,实现无人对行行走。
所述RVMU网络视频监控单元38可包括2-3个车载网络摄像头,优选FHD-639N型车载网络监控摄像头,所述车载网络摄像头支持H.264和H.265压缩格式,支持网络功能,防水等级为IP69K,接入到所述无线路由器31中。所述APP客户端1、所述远端平台2以及所述车载终端32可根据用户需要从网络访问所述车载网络摄像头的视频数据,对自走式喷杆喷雾机的作业环境和作业状态进行监控。
本发明还提供了上述自走式喷杆喷雾机的无人驾驶控制***的无人驾驶控制方法,包括:离线运行模式和在线运行模式;
在离线运行模式时,包括如下步骤:
步骤S101、车载终端从U盘获取GIS作业地图,解析出作业轨迹和作业边界,发送控制命令给VCU整车控制单元和ADCU自动驾驶控制单元,驱动自走式喷杆喷雾机寻找作业起始点;
步骤S102、当到达作业起始点时自动展开喷杆,VSCU变量喷雾控制单元开启变量喷雾作业,ADCU自动驾驶控制单元控制所述自走式喷杆喷雾机沿规划的作业轨迹行走;
步骤S103、当所述自走式喷杆喷雾机行走方向实时位置接近作业边界时,VCU整车控制单元控制所述自走式喷杆喷雾机自动减速,进入预掉头状态;
步骤S104、到达所述作业边界时,控制所述自走式喷杆喷雾机掉头,所述ADCU自动驾驶控制单元获取下一作业行的位置坐标,并驱动所述自走式喷杆喷雾机寻找给定的作业行位置坐标,开始连续作业;以及
步骤S105、作业过程中出现药液不足时,自动记忆当前作业位置坐标及返航轨迹并返回地头加药,加药完成后沿所述返航轨迹自动返回;
在线运行模式时,包括如下步骤:
步骤S201、车载终端从网络获取GIS作业地图,同时从所述远端平台和APP客户端获取控制命令,并根据所述控制命令控制所述自走式喷杆喷雾机完成基于作物行自动对行的无人航迹跟踪和变量喷药控制;
步骤S202、所述车载终端实时发送喷杆喷雾机作业状态信息,所述远端平台和客户端根据所述喷杆喷雾机作业状态信息实时监控机器状态;以及
步骤S203、所述远端平台根据需要开启或关闭RVMU网络视频监控单元,以减少网络资源消耗。
也即本发明的该车载平台3有离线运行和在线运行两种工作方式。离线运行时,所述车载终端32从U盘获取GIS作业地图,解析出作业轨迹和作业边界,发送控制命令给所述VCU整车控制单元33和所述ADCU自动驾驶控制单元37,驱动喷杆喷雾机寻找作业起始点;当到达作业起始点时自动展开喷杆,然后发送命令控制所述VSCU变量喷雾控制单元34开启变量喷雾作业,并控制喷杆喷雾机沿规划的作业轨迹行走;当喷杆喷雾机行走方向实时位置快要到达作业边界时,喷杆喷雾机自动减速,进入预掉头状态;到达作业边界时,进入掉头状态,此时发送下一作业行的位置坐标给ADCU自动驾驶控制单元37,驱动喷杆喷雾机寻找给定的作业行的位置坐标,然后开始连续作业;作业过程中出现药液不够需要返回地头加药时,自动记忆当前作业位置坐标及返航轨迹,加药完成自动沿返航轨迹返回。
在线运行时,所述车载终端32从网络获取GIS作业地图,同时从所述远端平台2和APP客户端1获取手动控制命令(如发动机启停、喷杆升降、喷药***启停等);所述车载终端32实时发动喷杆喷雾机作业状态信息以便所述远端平台2和APP客户端1实时监控机器状态;所述远端平台2可根据需要开启和关闭RVMU网络视频监控单元38,以减少网络资源消耗。
本发明还提供包括上述自走式喷杆喷雾机的无人驾驶控制***的自走式喷杆喷雾机,该自走式喷杆喷雾机采用上述的无人驾驶控制方法进行工作。该自走式喷杆喷雾机其他部分的组成、结构、相互位置关系、连接关系及其工作原理等,均为较成熟的现有技术,故在此不再赘述。其中,该自走式喷杆喷雾机的车载平台离线运行时,所述车载终端从U盘获取GIS作业地图,解析出作业轨迹和作业边界,发送控制命令给VCU整车控制单元和ADCU自动驾驶控制单元,驱动喷杆喷雾机寻找作业起始点;到达作业点时自动展开喷杆,然后发送命令给VSCU变量喷雾控制单元开始喷雾作业,并控制喷杆喷雾机沿规划的作业轨迹行走;当快要到达作业边界时,喷杆喷雾机自动减速,进入预掉头状态;到达作业边界时,进入掉头状态,驱动喷杆喷雾机寻找给定的下一作业行的位置坐标;作业过程中出现药液不够需要返回地头加药时,自动记忆当前作业位置坐标及返航轨迹,加药完成自动沿返航轨迹返回;车载平台在线运行时,所述车载终端从网络获取GIS作业地图和控制命令;所述远端平台可根据需要开启和关闭RVMU网络视频监控单元,以减少网络资源消耗。
本发明通过总线式模块结构加载各功能单元,实现了自走式喷杆喷雾机基于作物行自动对行的无人航迹跟踪和变量喷药控制。
当然,本发明还可有其它多种实施例,在不背离本发明精神及其实质的情况下,熟悉本领域的技术人员当可根据本发明作出各种相应的改变和变形,但这些相应的改变和变形都应属于本发明所附的权利要求的保护范围。
Claims (6)
1.一种自走式喷杆喷雾机的无人驾驶控制***,其特征在于,用于自走式喷杆喷雾机基于作物行自动对行的无人航迹跟踪和变量喷药控制,设置离线模式和在线模式,以在网络信号弱或无网络信号时切换避免影响正常作业;所述无人驾驶控制***包括:
车载平台,安装在自走式喷杆喷雾机上,所述车载平台可离线运行或在线运行,进行所述自走式喷杆喷雾机的控制或状态监控,所述车载平台包括无线路由器、车载终端、ADCU自动驾驶控制单元、INS组合惯导***、发动机ECU单元、VCU整车控制单元、VSCU变量喷雾控制单元和RVMU网络视频监控单元,所述车载终端分别与所述ADCU自动驾驶控制单元、INS组合惯导***、发动机ECU单元、VCU整车控制单元、VSCU变量喷雾控制单元和RVMU网络视频监控单元连接;
远端平台,安装有基于GIS组件的远程作业管理***,通过通信网络与所述车载平台通信,用于生成GIS作业地图、变量喷雾作业管理、农机作业参数设置、农机实时监控与作业轨迹显示、远程启停及作业控制、历史作业数据管理及无线通信处理;以及
客户端,用于所述自走式喷杆喷雾机的遥控手动作业控制,并实时接收所述车载平台的网络视频监控信息;
其中,通过总线式模块结构加载各功能单元,实现作物行自动对行的无人航迹跟踪和变量喷药控制,所述无线路由器为集成4G/5G网络模块和多个以太网接口的工业级无线路由器,与所述车载终端、所述ADCU自动驾驶控制单元和所述RVMU网络视频监控单元连接,实现本地高速网络通信;同时通过所述4G/5G网络模块对本地数据进行转发,实现与所述远端平台和所述客户端的无线网络交互;
所述车载终端为嵌入式PC终端,包含CAN总线、以太网和RS232通信接口,用以支持连接不同的控制单元;在线模式时,所述车载终端通过以太网接收并解析来自所述远端平台或所述客户端的命令数据,并通过所述CAN总线分发给所述VSCU变量喷雾控制单元、所述VCU整车控制单元和所述ADCU自动驾驶控制单元;离线模式时,通过所述车载终端的触摸屏监控车辆状态和设置车辆参数,以U盘导入作业计划并对所述作业计划进行分解,发送相应命令给相关控制单元实现变量喷雾控制、喷杆控制、车速控制、灯光控制、导航定位与轨迹跟踪、作物行对行控制和地头转弯掉头;
所述VSCU变量喷雾控制单元包括喷雾主控制器、五路喷杆分段开关阀、喷雾压力传感器、喷雾流量传感器和电动调节阀,所述喷雾主控制器为车载控制器,集成有IO端口和CAN通讯端口,所述喷雾主控制器通过所述IO端口控制所述五路喷杆分段开关阀控制喷杆作业喷幅;并采集所述喷雾压力传感器和所述喷雾流量传感器的信号,根据车辆行驶速度信号生成控制输出信号驱动所述电动调节阀动作,实时对喷雾流量进行调节,实现基于作业速度的变量喷雾作业;
所述ADCU自动驾驶控制单元包括自动驾驶主控制器、激光雷达、转向角度传感器和转向电机,所述自动驾驶主控制器用于接收所述转向角度传感器和激光雷达的信息,对视域范围内的空间环境进行点云信息识别提取和三维重构建模,获得实时作业环境地图,识别作物行走行信息,融合高精度导航定位信息和机器姿态信息,并与预置的高精度作业地图数据进行比对,计算整机相对规划路径的偏离值,演算目标转向角度和转向速度,控制所述转向电机动作,实现无人对行行走;
所述VCU整车控制单元包括整车主控制器、喷杆控制阀组、行走控制阀组、轮距控制阀组、启动及ON档继电器、灯光继电器、行走液压***压力传感器和行走速度传感器,所述整车主控制器集成IO端口和至少2路CAN通讯端口,用于采集所述行走液压***压力传感器信号和行走速度传感器信号实时监测车辆行走***状态,所述整车主控制器所采集的信号均采用标准协议发送到CAN总线上,同时从所述CAN总线上获取并解析控制输出命令;所述喷杆控制阀组用于控制喷杆的折叠、展开和升降;所述行走控制阀组用于控制行走柱塞泵的电比例,实现所述自走式喷杆喷雾机的无极调速控制;所述轮距控制阀组用于作业轮距的调节;所述启动及ON档继电器用于控制发动机启动机的运转和发动机ECU单元的运行,实现发动机点火和熄火;所述灯光继电器用于控制远近光灯和工作灯。
2.如权利要求1所述的自走式喷杆喷雾机的无人驾驶控制***,其特征在于,所述远端平台通信交互的作业参数、轨迹点数据和视频监控数据可选择性切换使用,以节约数据流量资源。
3.如权利要求1所述的自走式喷杆喷雾机的无人驾驶控制***,其特征在于,所述RVMU网络视频监控单元包括多个车载网络摄像头,所述车载网络摄像头支持H.264和H.265压缩格式,所述远端平台可通过网络访问所述车载网络摄像头的视频数据,对所述自走式喷杆喷雾机的作业环境和作业状态进行监控。
4.如权利要求1所述的自走式喷杆喷雾机的无人驾驶控制***,其特征在于,所述INS组合惯导***内置高精度定位模块、惯性测量单元和INS运算控制单元,所述高精度定位模块用于获取导航定位信息;所述惯性测量单元用于获取机器姿态信息;所述INS运算控制单元融合所述导航定位信息和机器姿态信息,并实时输出机器的姿态、方位、位置和速度数据。
5.一种自走式喷杆喷雾机的无人驾驶控制方法,其特征在于,用于权利要求1-4任意一项所述的无人驾驶控制***,包括:离线运行模式和在线运行模式;
所述离线运行模式时,包括如下步骤:
S101、车载终端从U盘获取GIS作业地图,解析出作业轨迹和作业边界,发送控制命令给VCU整车控制单元和ADCU自动驾驶控制单元,驱动自走式喷杆喷雾机寻找作业起始点;
S102、当到达作业起始点时自动展开喷杆,VSCU变量喷雾控制单元开启变量喷雾作业,ADCU自动驾驶控制单元控制所述自走式喷杆喷雾机沿规划的作业轨迹行走;
S103、当所述自走式喷杆喷雾机行走方向实时位置接近作业边界时,VCU整车控制单元控制所述自走式喷杆喷雾机自动减速,进入预掉头状态;
S104、到达所述作业边界时,控制所述自走式喷杆喷雾机掉头,所述ADCU自动驾驶控制单元获取下一作业行的位置坐标,并驱动所述自走式喷杆喷雾机寻找给定的作业行位置坐标,开始连续作业;以及
S105、作业过程中出现药液不足时,自动记忆当前作业位置坐标及返航轨迹并返回地头加药,加药完成后沿所述返航轨迹自动返回;
所述在线运行模式时,包括如下步骤:
S201、车载终端从网络获取GIS作业地图,同时从所述远端平台和APP客户端获取控制命令,并根据所述控制命令控制所述自走式喷杆喷雾机完成基于作物行自动对行的无人航迹跟踪和变量喷药控制;
S202、所述车载终端实时发送喷杆喷雾机作业状态信息,所述远端平台和客户端根据所述喷杆喷雾机作业状态信息实时监控机器状态;以及
S203、所述远端平台根据需要开启或关闭RVMU网络视频监控单元,以减少网络资源消耗。
6.一种自走式喷杆喷雾机,其特征在于,包括权利要求1-4任意一项所述的无人驾驶控制***。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210098231.5A CN114527727B (zh) | 2022-01-19 | 2022-01-19 | 一种自走式喷杆喷雾机及其无人驾驶控制***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210098231.5A CN114527727B (zh) | 2022-01-19 | 2022-01-19 | 一种自走式喷杆喷雾机及其无人驾驶控制***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114527727A CN114527727A (zh) | 2022-05-24 |
CN114527727B true CN114527727B (zh) | 2023-11-17 |
Family
ID=81623007
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210098231.5A Active CN114527727B (zh) | 2022-01-19 | 2022-01-19 | 一种自走式喷杆喷雾机及其无人驾驶控制***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114527727B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109521773A (zh) * | 2018-12-26 | 2019-03-26 | 安徽农业大学 | 一种基于物联网的热雾机机群控制***及方法 |
CN117356546B (zh) * | 2023-12-01 | 2024-02-13 | 南京禄口国际机场空港科技有限公司 | 一种机场草坪用的喷雾车的控制方法、***及存储介质 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05137490A (ja) * | 1991-11-18 | 1993-06-01 | Yanmar Agricult Equip Co Ltd | 自動走行型薬剤散布機 |
US5755382A (en) * | 1995-08-14 | 1998-05-26 | Skotinkov; Andrey V. | Self-propelled sprayer |
CN102613160A (zh) * | 2012-03-22 | 2012-08-01 | 北京农业信息技术研究中心 | 用于葡萄园的自走变量喷药装置及其喷药方法 |
CN105532623A (zh) * | 2016-02-18 | 2016-05-04 | 江苏大学 | 一种智能自走式风送静电式对靶喷雾机 |
CN107631756A (zh) * | 2017-10-09 | 2018-01-26 | 江苏大学 | 自走式喷杆喷雾机车载信息***及作业质量可视化方法 |
JP2018102205A (ja) * | 2016-12-26 | 2018-07-05 | 井関農機株式会社 | 自走式防除機 |
CN208692137U (zh) * | 2018-06-06 | 2019-04-05 | 山东农业工程学院 | 一种促进农业发展的智能遥控自走式喷雾机 |
CN109717175A (zh) * | 2019-03-06 | 2019-05-07 | 山东交通学院 | 果园智能自行走式喷雾***及其控制方法 |
CN112248740A (zh) * | 2020-11-18 | 2021-01-22 | 石河子大学 | 自走式喷雾机悬架***及其控制方法 |
CN113598151A (zh) * | 2021-08-20 | 2021-11-05 | 上海联适导航技术股份有限公司 | 一种基于北斗导航定位***的无人驾驶植保机 |
CN113885516A (zh) * | 2021-10-26 | 2022-01-04 | 天津易鼎丰动力科技有限公司 | 一种电动拖拉机自动驾驶域控制器及其控制方法 |
CN215454916U (zh) * | 2021-07-20 | 2022-01-11 | 山东五征集团有限公司 | 宽幅喷杆式喷药机地头管理控制*** |
CN113939452A (zh) * | 2020-05-22 | 2022-01-14 | 深圳市大疆创新科技有限公司 | 一种喷洒控制方法及装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10653128B2 (en) * | 2017-08-23 | 2020-05-19 | Cnh Industrial America Llc | Spray system for a self-propelled agricultural machine having adjustable tread width and rear wheel nozzles |
-
2022
- 2022-01-19 CN CN202210098231.5A patent/CN114527727B/zh active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05137490A (ja) * | 1991-11-18 | 1993-06-01 | Yanmar Agricult Equip Co Ltd | 自動走行型薬剤散布機 |
US5755382A (en) * | 1995-08-14 | 1998-05-26 | Skotinkov; Andrey V. | Self-propelled sprayer |
CN102613160A (zh) * | 2012-03-22 | 2012-08-01 | 北京农业信息技术研究中心 | 用于葡萄园的自走变量喷药装置及其喷药方法 |
CN105532623A (zh) * | 2016-02-18 | 2016-05-04 | 江苏大学 | 一种智能自走式风送静电式对靶喷雾机 |
JP2018102205A (ja) * | 2016-12-26 | 2018-07-05 | 井関農機株式会社 | 自走式防除機 |
CN107631756A (zh) * | 2017-10-09 | 2018-01-26 | 江苏大学 | 自走式喷杆喷雾机车载信息***及作业质量可视化方法 |
CN208692137U (zh) * | 2018-06-06 | 2019-04-05 | 山东农业工程学院 | 一种促进农业发展的智能遥控自走式喷雾机 |
CN109717175A (zh) * | 2019-03-06 | 2019-05-07 | 山东交通学院 | 果园智能自行走式喷雾***及其控制方法 |
CN113939452A (zh) * | 2020-05-22 | 2022-01-14 | 深圳市大疆创新科技有限公司 | 一种喷洒控制方法及装置 |
CN112248740A (zh) * | 2020-11-18 | 2021-01-22 | 石河子大学 | 自走式喷雾机悬架***及其控制方法 |
CN215454916U (zh) * | 2021-07-20 | 2022-01-11 | 山东五征集团有限公司 | 宽幅喷杆式喷药机地头管理控制*** |
CN113598151A (zh) * | 2021-08-20 | 2021-11-05 | 上海联适导航技术股份有限公司 | 一种基于北斗导航定位***的无人驾驶植保机 |
CN113885516A (zh) * | 2021-10-26 | 2022-01-04 | 天津易鼎丰动力科技有限公司 | 一种电动拖拉机自动驾驶域控制器及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114527727A (zh) | 2022-05-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114527727B (zh) | 一种自走式喷杆喷雾机及其无人驾驶控制***及方法 | |
CN110531764B (zh) | 一种无人驾驶拖拉机控制***及控制方法 | |
CN108609014B (zh) | 智能车辆的横向控制方法及装置 | |
CN105137997B (zh) | 水利施工振动碾压机自动驾驶***与方法 | |
CN207198663U (zh) | 压路机及压路机控制*** | |
CN106132187B (zh) | 作业车辆的控制装置 | |
EP2177965B1 (en) | High integrity coordination for multiple off-road machines | |
CN107808550B (zh) | 一种植保无人机管理*** | |
CN109717175B (zh) | 果园智能自行走式喷雾***及其控制方法 | |
CN102368158B (zh) | 一种果园机械导航定位方法 | |
EP2177964A2 (en) | High integrity coordination system for multiple off-road machines | |
CN110488598A (zh) | 陆空两栖无人车控制*** | |
CN207216418U (zh) | 农业机器人自动驾驶*** | |
CN111459172A (zh) | 围界安防无人巡逻车自主导航*** | |
CN110989545A (zh) | 基于云端平台农用无人车管理***及方法 | |
CN108669046B (zh) | 融合视觉导航与北斗定位的植保无人车及控制方法 | |
CN109254545A (zh) | 一种多个无人农机车辆远程集中控制***与方法 | |
CN109508006A (zh) | 一种基于北斗的汽车起重机的自动驾驶*** | |
CN209749570U (zh) | 果园智能自行走式喷雾*** | |
CN106382916B (zh) | 自建参考系的双六足机器人复杂地形三维立体测绘***与方法 | |
CN109782771B (zh) | 一种果园移动机器人及地头转向方法 | |
CN211906081U (zh) | 基于路径跟踪的无人驾驶小型扫路车控制*** | |
CN208335015U (zh) | 基于视觉slam导航技术的无人驾驶植保喷施*** | |
CN114089650B (zh) | 一种基于物联网的智能农田喷药电子自动控制*** | |
CN217195348U (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |