CN111103880A - 一种无人谷物联合收割机协同导航作业路径规划系统与方法 - Google Patents

一种无人谷物联合收割机协同导航作业路径规划系统与方法 Download PDF

Info

Publication number
CN111103880A
CN111103880A CN201911337126.7A CN201911337126A CN111103880A CN 111103880 A CN111103880 A CN 111103880A CN 201911337126 A CN201911337126 A CN 201911337126A CN 111103880 A CN111103880 A CN 111103880A
Authority
CN
China
Prior art keywords
grain
path planning
combine harvester
harvester
return
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.)
Granted
Application number
CN201911337126.7A
Other languages
English (en)
Other versions
CN111103880B (zh
Inventor
崔冰波
魏新华
卢泽民
王爱臣
吉鑫
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu University
Original Assignee
Jiangsu University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Jiangsu University filed Critical Jiangsu University
Priority to CN201911337126.7A priority Critical patent/CN111103880B/zh
Publication of CN111103880A publication Critical patent/CN111103880A/zh
Application granted granted Critical
Publication of CN111103880B publication Critical patent/CN111103880B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay

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)
  • Guiding Agricultural Machines (AREA)

Abstract

本发明公开了一种无人谷物联合收割机协同导航作业路径规划系统与方法，RTK‑GNSS采集田块地理信息，发送给导航终端，进行田间作业预规划、确定卸粮返航点坐标及运粮车位置，生成多段作业路径数据，从而实现断点续航路径规划；联合收割机作业过程中，RTK‑GNSS实时采集收割机的位置和航向，并发送给导航终端，导航终端根据横向误差、航向误差和路径规划结果，发送期望转向角至行车控制器进行差速转向控制。本发明在收割机田间无人作业的路径规划中，结合卸粮过程的断点续航路径规划，可有效减少收割机在田空跑时间，从而减少土壤压实，提高收割作业效率及能源利用率。

Description

一种无人谷物联合收割机协同导航作业路径规划系统与方法
技术领域
本发明属于智能农机与精准农业领域，具体涉及一种无人谷物联合收割机协同导航作业路径规划系统与方法。
背景技术
近年来随着北斗导航系统的普及与推广应用，基于自动导航系统的谷物联合收割机相继在各地进行作业示范，无人作业的谷物联合收割机受到了广泛的关注。然而，无人谷物收获作业不仅受田间联合收割机作业效率的影响，其卸粮环节也对无人谷物收获的综合作业效率影响显著。目前，大多数农机导航系统围绕联合收割机的导航控制、作业路径规划等做了大量的工作。然而，实际收获过程中联合收割机-运粮车的协同作业效率对全过程无人收割作业的影响不容忽视。
发明内容
有鉴于此，本发明提供了一种提高谷物联合收割机工作效率、能源利用率，减少卸粮过程中土壤压实的协同导航作业路径规划系统与方法。
本发明是通过以下技术手段实现上述技术目的的。
一种无人谷物联合收割机协同导航作业路径规划方法，由联合收割机断点续航路径规划，实现收割机-运粮车协同作业路径跟踪控制；
所述联合收割机断点续航路径规划具体过程为：首先进行田间作业预规划，确定卸粮返航点坐标及运粮车位置，最后生成多段作业路径数据；
所述卸粮返航点坐标为：
Figure BDA0002331233330000011
其中：返航点坐标Zk为预规划的直线路径中的第k个直线轨迹端点序号；j为返航点索引，j＝1,2,…,n；Lm为单次满幅收割作业的收割机最大行程；a-2d为联合收割机进行最外圈谷物收割后，田块剩余的长边；
所述运粮车位置的确定过程为：当返航点的个数为奇数时，选择中间返航点的Y坐标作为运粮车Y轴向坐标；当为返航点为偶数时，选择中间两返航点中的任意一点Y坐标作为运粮车Y轴向坐标；联合收割机在运粮车位置进行卸粮，卸粮次数n＝INT(Lt/Lm)+1，其中INT(·)为取整数操作符，Lt为田块收割作业总行程数；
所述多段作业路径的生成过程为：依次对回字形直线路径行端点的起始点到第1个返航点、第j返航点至第j+1个返航点、第n个返航点至作业终点进行回字形路径规划；
所述收割机-运粮车协同作业路径跟踪控制具体为：导航终端实时测量收割机当前的横向偏差和航向偏差，结合断点续航路径规划计算出期望转向角度，发送至行车控制器进行差速转向控制。
一种无人谷物联合收割机协同导航作业路径规划系统，包括导航终端，所述导航终端进行田间作业预规划、确定卸粮返航点坐标及运粮车位置，并生成多段作业路径数据，实现断点续航路径规划；导航终端结合收割机实时的位置和航向，获取收割机协同导航跟踪控制的期望转向角；还包括RTK-GNSS和行车控制器，所述RTK-GNSS用于采集田块地理信息，并实时感知收割机的位置和航向；所述行车控制器接收期望转向角，并进行差速转向控制。
本发明提出一种无人谷物联合收割机协同导航作业路径规划系统与方法，相比现有技术，具有以下有益效果：
本发明由联合收割机断点续航路径规划，实现收割机-运粮车协同作业路径跟踪控制，联合收割机断点续航路径规划包括田间作业路径预规划、卸粮返航点坐标及运粮车位置确定以及生成多段作业路径数据；本发明将收割机卸粮过程的断点续航路径规划统筹至田间无人作业的路径规划中，改善了收割机自主作业的智能化程度；有效减少了收割机在田空跑距离，减少土壤压实，提高收割作业效率及能源利用率。
附图说明
图1为本发明无人谷物联合收割机断点续航路径规划流程图；
图2为本发明无人谷物联合收割机返航点及运粮车位置选择示意图；
图3为本发明无人谷物联合收割机收割机-运粮车协同作业路径跟踪控制流程图。
具体实施方式
下面结合附图以及具体实施例对本发明作进一步的说明，但本发明的保护范围并不限于此。
一种无人谷物联合收割机协同导航作业路径规划系统，包括RTK-GNSS、导航终端和行车控制器，RTK-GNSS采集田块地理信息，发送给导航终端进行田间作业预规划、确定卸粮返航点坐标及运粮车位置，生成多段作业路径数据，实现断点续航路径规划；联合收割机作业时，RTK-GNSS实时感知收割机的位置和航向，发送给导航终端，计算出测量误差(横向误差和航向误差)，再结合断点续航路径规划计算出期望转向角，导航终端将期望转向角发送给行车控制器进行差速转向决策。
一种无人谷物联合收割机协同导航作业路径规划方法，由联合收割机断点续航路径规划，实现收割机-运粮车协同作业路径跟踪控制，减少卸粮环节土地压实和消耗时间，提高联合收割机的在田工作效率。
联合收割机断点续航路径规划的实施流程如图1所示，具体步骤为：
步骤(1)，生成直线轨迹端点
给导航终端和接收机上电，RTK-GNSS采集田块地理信息，计算得到田块的尺寸信息，导航终端根据田块尺寸、收割机作业幅宽d进行田间作业直线路径的预规划，预规划坐标系以田块左下角为原点，沿田块左侧长边方向的向量为x轴，沿田块短边方向的向量为y轴，该坐标系的所有坐标值均在高斯平面坐标系下表示；预规划过程中采用多次往返的直线路径进行收割机转弯轨迹的逼近，为现有技术；存储田块路径预规划生成的回字形直线轨迹端点信息。
步骤(2)，确定卸粮返航点在预规划路径中的坐标，获取作业路径数据
由单位面积产量ρ、收割机粮厢可容纳产量V和作业幅宽d(本实施例已知单位面积产量、粮厢可容纳产量和作业幅宽)，计算单次满幅收割作业的收割机最大行程Lm，Lm＝V/(ρ*d)。设矩形田块长边尺寸为a、短边尺寸为b，收割机沿长边向运粮车所在反方向收割作业。人工驾驶联合收割机进行最外圈谷物收割后，田块剩余的长边和短边尺寸分别为：a-2d、b-2d，则联合收割机沿长边方向的作业行数为r＝INT((b-2d)/d)+1，其中INT(·)为取整数操作符。每行的作业长度为a-2d，当前田块收割作业总行程数Lt＝r(a-2d)，则卸粮次数n＝INT(Lt/Lm)+1。设联合收割机由田块左下角开始作业，为减少卸粮过程的田块土壤压实，卸粮返航点的选择如图2所示，即在田块靠近运粮车一端设置返航点，具体如下：
Figure BDA0002331233330000031
其中返航点索引j＝1,2,…,n；Zk为预规划的直线路径中的第k个直线轨迹端点序号，返航点坐标即为第k个直线轨迹端点坐标，不需要重新生成。
在回字形直线路径靠近卸粮车一端的规划行端点处设置卸粮的返航点，依次对行端点的起始点到第1个返航点、第j返航点至第j+1个返航点、第n个返航点至作业终点进行回字形路径规划，得到n段路径。
步骤(3)，优化运粮车位置选择
如图2所示，由于运粮车不下地，其X轴方向的坐标可设置为0，运粮车位置选择由Y轴向坐标确定。假设卸粮过程联合收割机匀速行驶，为减少卸粮过程消耗时间，以卸粮总路径最短为准则选择运粮车Y轴向坐标。当返航点的个数为奇数时，选择中间返航点的Y坐标作为运粮车Y轴向坐标；当为返航点为偶数时，选择中间两返航点中的任意一点Y坐标作为运粮车Y轴向坐标。
如图3所示，收割机-运粮车协同作业路径跟踪控制，具体步骤为：
联合收割机启动后，导航终端、接收机、行车控制器依次上电，联合收割机沿田块长边直线收割作业，由导航终端实时测量收割机当前的横向偏差和航向偏差，并结合断点续航路径规划计算出期望转向角度发送至行车控制器进行差速转向决策，计算期望转向角度为现有技术。当导航终端的路径搜索模块检测到当前为转弯直线路径时，行车控制器进行多次往返的直线路径跟踪，导航终端实时测量收割机当前的横向偏差和航向偏差，并结合断点续航路径规划计算出期望转向角度发送至行车控制器进行差速转向决策。路径搜索模块在确认当前行作业结束时，由直线轨迹端点(行端点)判断是否到达卸粮返航点，如果没有到达，则联合收割机继续沿田块长边直线收割作业；若到达卸粮返航点，则根据返航点坐标和运粮车的坐标即时规划卸粮直线路径，控制收割机行驶至运粮车附近卸粮；卸粮结束后，导航终端进行路径数据段索引的更新，并判断当前路径数据段是否有效，如有效则更新路段数据，并进入沿长边直线收割作业环节，否则结束收割作业。
以上所述仅是本发明的优选实施方式，应当指出：对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。

Claims (9)

1.一种无人谷物联合收割机协同导航作业路径规划方法，其特征在于，由联合收割机断点续航路径规划，实现收割机-运粮车协同作业路径跟踪控制。
2.根据权利要求1所述的无人谷物联合收割机协同导航作业路径规划方法，其特征在于，所述联合收割机断点续航路径规划具体过程为：首先进行田间作业预规划，确定卸粮返航点坐标及运粮车位置，最后生成多段作业路径数据。
3.根据权利要求2所述的无人谷物联合收割机协同导航作业路径规划方法，其特征在于，所述卸粮返航点坐标为：
Figure FDA0002331233320000011
其中：返航点坐标Zk为预规划的直线路径中的第k个直线轨迹端点序号；j为返航点索引，j＝1,2,…,n；Lm为单次满幅收割作业的收割机最大行程；a-2d为联合收割机进行最外圈谷物收割后，田块剩余的长边。
4.根据权利要求3所述的无人谷物联合收割机协同导航作业路径规划方法，其特征在于，所述运粮车位置的确定过程为：当返航点的个数为奇数时，选择中间返航点的Y坐标作为运粮车Y轴向坐标；当为返航点为偶数时，选择中间两返航点中的任意一点Y坐标作为运粮车Y轴向坐标。
5.根据权利要求4所述的无人谷物联合收割机协同导航作业路径规划方法，其特征在于，联合收割机在运粮车位置进行卸粮，卸粮次数n＝INT(Lt/Lm)+1，其中INT(·)为取整数操作符，Lt为田块收割作业总行程数。
6.根据权利要求2所述的无人谷物联合收割机协同导航作业路径规划方法，其特征在于，所述多段作业路径的生成过程为：依次对回字形直线路径行端点的起始点到第1个返航点、第j返航点至第j+1个返航点、第n个返航点至作业终点进行回字形路径规划。
7.根据权利要求1所述的无人谷物联合收割机协同导航作业路径规划方法，其特征在于，所述收割机-运粮车协同作业路径跟踪控制具体为：导航终端实时测量收割机当前的横向偏差和航向偏差，结合断点续航路径规划计算出期望转向角度，发送至行车控制器进行差速转向控制。
8.一种根据权利要求1-7任一项权利要求所述的无人谷物联合收割机协同导航作业路径规划系统，其特征在于，包括导航终端，所述导航终端进行田间作业预规划、确定卸粮返航点坐标及运粮车位置，并生成多段作业路径数据，实现断点续航路径规划；导航终端结合收割机实时的位置和航向，获取收割机协同导航跟踪控制的期望转向角。
9.根据权利要求8所述的无人谷物联合收割机协同导航作业路径规划系统，其特征在于，还包括RTK-GNSS和行车控制器，所述RTK-GNSS用于采集田块地理信息，并实时感知收割机的位置和航向；所述行车控制器接收期望转向角，并进行差速转向控制。
CN201911337126.7A 2019-12-23 2019-12-23 一种无人谷物联合收割机协同导航作业路径规划系统与方法 Active CN111103880B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911337126.7A CN111103880B (zh) 2019-12-23 2019-12-23 一种无人谷物联合收割机协同导航作业路径规划系统与方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911337126.7A CN111103880B (zh) 2019-12-23 2019-12-23 一种无人谷物联合收割机协同导航作业路径规划系统与方法

Publications (2)

Publication Number Publication Date
CN111103880A true CN111103880A (zh) 2020-05-05
CN111103880B CN111103880B (zh) 2023-03-21

Family

ID=70423754

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911337126.7A Active CN111103880B (zh) 2019-12-23 2019-12-23 一种无人谷物联合收割机协同导航作业路径规划系统与方法

Country Status (1)

Country Link
CN (1) CN111103880B (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113188548A (zh) * 2021-06-02 2021-07-30 山东省农业科学院科技信息研究所 一种基于作业行的自主导航作业路径规划方法
CN113625615A (zh) * 2021-07-13 2021-11-09 洛阳拖拉机研究所有限公司 一种无人驾驶拖拉机及收获机协同作业系统及控制方法
CN114737553A (zh) * 2020-12-29 2022-07-12 诺瓦特伦有限公司 用于压实土壤的方法和土壤压实机
CN114935929A (zh) * 2022-04-08 2022-08-23 广州工程技术职业学院 一种农业机械信息化监控管理系统
CN115060272A (zh) * 2022-08-08 2022-09-16 农业农村部南京农业机械化研究所 一种无人驾驶联合收获机路径规划方法及系统
CN115067061A (zh) * 2022-05-18 2022-09-20 江苏大学 一种粮箱卸粮返航位置监测系统及方法和收获机

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104898687A (zh) * 2014-08-21 2015-09-09 宁波市鄞州麦谷农业科技有限公司 履带式联合收割机的自动驾驶系统及其控制方法
US20170227968A1 (en) * 2016-02-04 2017-08-10 Proxy Technologies, Inc. Unmanned or optionally manned vehicle, system and methods for determining positional information of unmanned or optionally manned vehicles
CN107943049A (zh) * 2017-12-13 2018-04-20 江西洪都航空工业集团有限责任公司 一种无人车控制方法及无人割草车
CN109115225A (zh) * 2018-08-31 2019-01-01 江苏大学 一种无人作业谷物联合收割机导航方法与导航装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104898687A (zh) * 2014-08-21 2015-09-09 宁波市鄞州麦谷农业科技有限公司 履带式联合收割机的自动驾驶系统及其控制方法
US20170227968A1 (en) * 2016-02-04 2017-08-10 Proxy Technologies, Inc. Unmanned or optionally manned vehicle, system and methods for determining positional information of unmanned or optionally manned vehicles
CN107943049A (zh) * 2017-12-13 2018-04-20 江西洪都航空工业集团有限责任公司 一种无人车控制方法及无人割草车
CN109115225A (zh) * 2018-08-31 2019-01-01 江苏大学 一种无人作业谷物联合收割机导航方法与导航装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
蔡中伟: "无人驾驶稻谷田间转运车开发设想", 《农机化研究》 *

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114737553A (zh) * 2020-12-29 2022-07-12 诺瓦特伦有限公司 用于压实土壤的方法和土壤压实机
CN113188548A (zh) * 2021-06-02 2021-07-30 山东省农业科学院科技信息研究所 一种基于作业行的自主导航作业路径规划方法
CN113188548B (zh) * 2021-06-02 2022-08-02 山东省农业科学院科技信息研究所 一种基于作业行的自主导航作业路径规划方法
CN113625615A (zh) * 2021-07-13 2021-11-09 洛阳拖拉机研究所有限公司 一种无人驾驶拖拉机及收获机协同作业系统及控制方法
CN113625615B (zh) * 2021-07-13 2024-02-02 洛阳拖拉机研究所有限公司 一种无人驾驶拖拉机及收获机协同作业系统及控制方法
CN114935929A (zh) * 2022-04-08 2022-08-23 广州工程技术职业学院 一种农业机械信息化监控管理系统
CN114935929B (zh) * 2022-04-08 2023-08-15 广州工程技术职业学院 一种农业机械信息化监控管理系统
CN115067061A (zh) * 2022-05-18 2022-09-20 江苏大学 一种粮箱卸粮返航位置监测系统及方法和收获机
CN115067061B (zh) * 2022-05-18 2024-04-09 江苏大学 一种粮箱卸粮返航位置监测系统及方法和收获机
CN115060272A (zh) * 2022-08-08 2022-09-16 农业农村部南京农业机械化研究所 一种无人驾驶联合收获机路径规划方法及系统
CN115060272B (zh) * 2022-08-08 2022-11-29 农业农村部南京农业机械化研究所 一种无人驾驶联合收获机路径规划方法及系统

Also Published As

Publication number Publication date
CN111103880B (zh) 2023-03-21

Similar Documents

Publication Publication Date Title
CN111103880B (zh) 一种无人谷物联合收割机协同导航作业路径规划系统与方法
US11006564B2 (en) Path planning system for autonomous off-road vehicles
US10394238B2 (en) Multi-mode mission planning and optimization for autonomous agricultural vehicles
EP1406140B1 (en) System for determining an energy-efficient path of a machine
Spekken et al. Optimized routing on agricultural fields by minimizing maneuvering and servicing time
US10254765B2 (en) Coordination of vehicle movement in a field
CN109634276B (zh) 农用车辆无人驾驶控制方法、系统及该农用车辆
EP3805701A1 (en) Route planning method for mobile vehicle
Jin et al. Optimal coverage path planning for arable farming on 2D surfaces
US7706948B2 (en) Method for creating spiral swaths for irregular field boundaries
US20180364739A1 (en) Choreographer system for autonomous off-road vehicles
Kurita et al. Rice autonomous harvesting: Operation framework
WO2017214437A1 (en) Swath tracking system for an off-road vehicle
Bochtis et al. A mission planner for an autonomous tractor
EP2519093A2 (en) Guidance using a worked edge for wayline generation
CN107943049A (zh) 一种无人车控制方法及无人割草车
Auat Cheein et al. Agricultural service unit motion planning under harvesting scheduling and terrain constraints
CN109407704B (zh) 一种智能的无人机返航控制系统
JP2019082846A (ja) 協調作業システム
CN114705194A (zh) 基于拓扑地图和时间窗多农机协同全局路径冲突检测方法
CN109572857A (zh) 一种麦克纳姆轮智能仓储agv及其路径规划方法
CN114265409A (zh) 轨迹信息处理方法、装置及地面设备
Wang et al. Full coverage path planning methods of harvesting robot with multi-objective constraints
CN111103886A (zh) 通行窄道的识别方法、装置、设备及计算机可读存储介质
CN112731934B (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