CN110843907B - 一种基于分块的作业区域路径规划方法及装置 - Google Patents
一种基于分块的作业区域路径规划方法及装置 Download PDFInfo
- Publication number
- CN110843907B CN110843907B CN201911196765.6A CN201911196765A CN110843907B CN 110843907 B CN110843907 B CN 110843907B CN 201911196765 A CN201911196765 A CN 201911196765A CN 110843907 B CN110843907 B CN 110843907B
- Authority
- CN
- China
- Prior art keywords
- steering
- sub
- stroke
- block
- turning
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/001—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits the torque NOT being among the input parameters
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q10/00—Administration; Management
- G06Q10/04—Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
- G06Q10/047—Optimisation of routes or paths, e.g. travelling salesman problem
Landscapes
- Engineering & Computer Science (AREA)
- Business, Economics & Management (AREA)
- Human Resources & Organizations (AREA)
- Strategic Management (AREA)
- Economics (AREA)
- Quality & Reliability (AREA)
- Physics & Mathematics (AREA)
- Entrepreneurship & Innovation (AREA)
- Marketing (AREA)
- Operations Research (AREA)
- Development Economics (AREA)
- Tourism & Hospitality (AREA)
- Game Theory and Decision Science (AREA)
- General Business, Economics & Management (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Guiding Agricultural Machines (AREA)
Abstract
本发明涉及一种基于分块的作业区域路径规划方法及装置。该方法包括:周边参数获取步骤,获得农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角;子分块确定步骤,根据所述周边直线行程、周边转向行程以及各转向角,确定子分块以及子分块跨度;转向模式确定步骤,根据所述子分块跨度q的奇偶性,确定转向模式,其中,所述方法还包括:子分块直行行程确定步骤,确定各子分块的直行行程;子分块转向行程确定步骤,确定各子分块的转向行程;行程规划图制作步骤,根据所述转向模式、所述直行行程和转向行程制作行程规划图。
Description
本发明是申请号为201711304162.4、申请日为2017年12月11日、发明名称为“作业区域路径规划方法和装置”的发明申请的分案申请。
技术领域
本发明涉及农业机械自动化技术领域,更具体地涉及一种作业区域路径规划方法及装置。
背景技术
在拖拉机组田间作业过程中,作业人员常根据经验和一些常识性规则进行田间作业路径设计,存在重耕、漏耕、多走路程等问题,影响作业生产效率。利用拖拉机自动作业技术能够有效减少相邻作业行间的重叠和遗漏,是提高农田作业质量和效率、降低作业成本的重要技术手段。对于拖拉机全覆盖自动作业系统,必须给定明确的田间作业路径,才能进行正常的行走和作业,全覆盖自动作业路径规划设计具有重大意义。
目前,以全球定位系统(GPS)为代表的全球导航卫星系统(GNSS)技术应用逐渐满足农业生产对于静态定位或者动态定位的精度要求,它能够在作业前采集作业区域的地理信息,对作业路径进行合理规划;在作业过程中,控制拖拉机转向、加减速、制动等动作;而在完成田间作业后,对作业过程和作业效果进行评估以积累田间作业的经验。但GPS技术仍具有一定的局限性,该系统成本较高,且在获取农田地理位置的过程中,其精准度取决于拖拉机组所处的外界环境。对于信号微弱的偏远地区,需要一种既能满足使用要求,又能降低成本的拖拉机组自身传感技术实现农田地理位置参数的精准获取,从而无须依赖于外界GPS信号。
作业路径规划功能是实现拖拉机自动作业必不可少的重要前提,在拖拉机作业前或者作业过程中能够预先或者即时规划不同作业状况下的最优作业路径。转弯路径是从拖拉机进入地头转弯区域,到完成方向调转再次进入直线作业区域过程的行驶轨迹曲线。拖拉机的最小转弯半径限制了拖拉机的转弯方式,传统的转弯方式有弓形、半圆形、梨形以及鱼尾形等。但传统的半圆形、梨形和鱼尾形等转向路径较长,耗时较大,需要一种适应于作业区域边界转向角度的转弯路径,使拖拉机组转向时路径平行转向方向,从而使路径及耗时实现最优。
发明内容
本发明鉴于以上情况作出,用于缓解或克服现有技术中存在的一种或更多种的问题,或为之准备条件,至少提供一种有益的选择。
为了实现以上的目的,依据本发明的一个方面,提供了一种基于分块的作业区域路径规划方法,包括:周边参数获取步骤,获得农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角;子分块确定步骤,根据所述周边直线行程、周边转向行程以及各转向角,确定子分块以及子分块跨度;转向模式确定步骤,根据所述子分块跨度q的奇偶性,确定转向模式,其中,所述方法还包括:子分块直行行程确定步骤,确定各子分块的直行行程;子分块转向行程确定步骤,确定各子分块的转向行程;行程规划图制作步骤,根据所述转向模式、所述直行行程和转向行程制作行程规划图;其中,所述子分块转向行程计算步骤如下地确定转向行程:
式中,SCk为子分块集Bp对应转向点Ak的转向弧长,k为转向点序数,a为子分块集Bp首次调头转出子分块序数,b为子分块集Bp二次转回子分块序数,d是有效作业宽度,ai为转向点i的转向角;所述子分块直行行程计算步骤如下地确定直行行程:
式中,k1为子分块集Bp地头首端转向点序数,k2为子分块集Bp地头尾端转向点序数,maxp为子分块集Bp最大子分块序数。
依据本发明的另一个方面,提供了一种基于分块的作业区域路径规划装置,包括:周边参数获取单元,获得农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角;子分块确定单元,根据所述周边直线行程、周边转向行程以及各转向角,确定子分块以及子分块跨度;转向模式确定单元,根据所述子分块跨度q的奇偶性,确定转向模式,其中:子分块直行行程确定单元,确定各子分块的直行行程;子分块转向行程确定单元,确定各子分块的转向行程;行程规划图制作单元,根据所述转向模式、所述直行行程和转向行程制作行程规划图;其中,所述子分块转向行程计算单元如下地确定转向行程:
式中,SCk为子分块集Bp对应转向点Ak的转向弧长,k为转向点序数,a为子分块集Bp首次调头转出子分块序数,b为子分块集Bp二次转回子分块序数,d是有效作业宽度,ai为转向点i的转向角;所述子分块直行行程计算单元如下地确定直行行程:
式中,k1为子分块集Bp地头首端转向点序数,k2为子分块集Bp地头尾端转向点序数,maxp为子分块集Bp最大子分块序数。
依据本发明的实施方式,细分了整体作业区域,使得不依赖GPS定位而获得作业区域面积和进行农用机械作业控制成为可能。
附图说明
图1示出了依据本发明的一种实施方式的作业区域路径规划方法的示意性流程图。
图2示出了依据本发明的一种实施方式确定子分块作业行的示意性流程图。
图3示出了依据本发明一种实施方式的子分块以及子分块跨度确定的示例。
图4示出了子分块跨度奇偶模式下行驶间隔跨度及转向半径策略的示例。
图5示出了依据本发明的一种实施方式显示的实时路径规划图。
图6示出了依据本发明的一种实施方式的作业区域路径规划装置的示意性方框图。
图7示出了根据一种实施方式,转向行程确定单元的示意性方框图。
具体实施方式
下面结合附图对本发明的实施方式进行说明,所说明的实施方式只是示例性的,不是对发明的保护范围的限制。
图1示出了依据本发明的一种实施方式的作业区域路径规划方法的示意性流程图。图2示出了依据本发明的一种实施方式确定子分块作业行的示意性流程图。图3示出了依据本发明一种实施方式的子分块以及子分块跨度确定的示例。
如图1所示,依据本发明的一种实施方式的作业区域路径规划方法包括:周边参数获取步骤101,获得农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角;子分块作业行确定步骤102,根据所述周边直线行程、周边转向行程以及各转向角,确定子分块以及子分块跨度;转向模式确定步骤103,根据所述子分块跨度,确定转向模式。
在周边参数获取步骤101,可由实时车速记录仪与分时采集传感器协同工作,监测分时车速,包括直行车速和直行时间、转向车速和转向时间,并由转向角度传感器采集并记录转向角度。如果通过其他的各种方式已经获得了这些参数,也可以周边参数获取步骤101可以通过被输入或接收这些参数而获得这些参数。
具体地,拖拉机(拖拉机是本发明的农用机械的示例,为了方便进行描述,以下的示例中,用拖拉机来代表农用机械)初始不挂载农具,沿所预定的作业区域边界直行,实时车速记录仪采集直行分时车速信号。到达转向点后,停止分时车速采样,并存储该段直行路径中的所有车速信号,例如发送至数据闪存卡。拖拉机沿着作业区域转向边界进行转向,实时车速记录仪采集转向分时车速信号,转向角度传感器采集并记录转向角度。当完成转向后,停止采集分时车速,并将该段转向路径中的所有车速信号及转向角度发送至数据闪存卡。根据采集的分时车速信号计算这一段的周边直行行程及周边转向行程。拖拉机绕行作业区域地块一周,重复上述步骤采集各转向点的分时车速信号及转向角度,计算各段的周边直行行程及周边转向行程。各段的周边直行行程和周边转向行程也可以在收集了所有段的车速、时间之后集中运算,这些都在本发明的保护范围内。在图3的示例中,获得了合计9段直行行程(SLi)及8段转向行程(SCi)。
例如可以如下地计算各段的直行行程以及转向行程。
拖拉机沿作业区域边界直行时,实时车速记录仪按特定分时采样频率f0采集直行车速信号VL(t),按特定分时采样频率F0采集转向车速信号VC(t),同时转向角度传感器记录转向角度ai,通过拟合分时车速-时间函数,可计算得到该直线行程为转向行程为式中m、n均为采样序数。重复上述步骤,可计算获得各段的直行行程SLi及转向行程SCi。
然后,在子分块作业行确定步骤102,根据所述周边直线行程及周边转向行程,确定子分块以及子分块跨度。
如图2所示,依据本发明的一种实施方式,首先,在转向点坐标确定步骤201,根据周边直线行程及周边转向行程确定各转向点的位置坐标。可根据以下公式确定各转向点An的位置坐标:
由前三项可递推出转向点坐标公式如下:
然后,在基本分块区间集合确定步骤202,根据所述转向点的位置坐标和有效作业宽度获得等距基本分块区间的集合。
在步骤202中,根据一种实施方式,可如下地操作:
首先,获得作业区域等距总分块数N=[(xmax-xmin)/d],其中xmax是各转向点的横坐标的最大值,xmin是各转向点的横坐标的最小值,d是有效作业宽度。
接着,建立等差数列:{x0,x0+d,x0+2d,…,x0+jd,…,x0+Nd},以该等差数列相邻项建立区间集合Cj[x0+jd,x0+(j+1)d](j=0,1,…,N),即等距基本分块区间集合,各集合组成项称为基本分块区间,也可称为子分块作业行。
然后在分块序数间隔差确定步骤203,根据各转向点的位置坐标,确定各转向点的分块序数间隔差。
例如,可依次判别各转向点Ai横坐标xi所属区间,即可知各转向点Ai对应的分块序数j,从小到大排列。假定在图3所示的示例中,8个转向点的横坐标排序后分别为{A1→0;A2→6;A8→8;A3→12;A4→15;A7→15;A5→20;A6→20},计算相邻分块序数j间隔差值:{A2-A1=6;A8-A2=2;A3-A8=4;A4-A3=3;A7-A4=0;A5-A7=5;A6-A5=0}。
最后,子分块跨度确定步骤204,根据所述分块序数间隔差,确定子分块,以及子分块的跨度,子分块的跨度即该子分块中包含的基本分块区间的个数。
在以上的分块序数间隔差中,存在A4、A7及A5、A6分块序数间隔差值为0,则转向点A4与A7、A5与A6视为首尾等同点。因而得到5个非零分块序数间隔差,这表明可以将作业区域分成5个子分块。间隔差6、2、4、3、5分别为各子分块的跨度。
各子分块可表示为Bpq,其中p为子分块序数,q为子分块跨度。由图3示出:{A1→A2:B16;A2→A8:B22;A8→A3:B34;A3→A4:B43;A5→A7:B55}。第一子块包括B11-B16这6个基本分块区间。
在步骤102确定了子分块和子分块跨度之后,进入步骤103,根据所述子分块以及其跨度,设定转向模式,即如何转向的安排。
根据一种实施方式,根据子分块跨度q的奇偶性设定两种转向模式。如图4所示,奇数模式下,该子分块首端调头转向时,拖拉机按该段转向角度行驶间隔跨度为(q+1)/2的地块;同理,该子分块尾端调头转向时,拖拉机按该段转向角度行驶间隔跨度为(q-1)/2的地块。例如对于第5子分块,其转向顺序和方向为:B55:{B53↓,B51↑,B54↓,B52↑,B55↓},因为,q=5,(5+1)/2=3,因而首先从B53向下直行,到达另一端时,因为(5-1)/2=2,而3-2=1,因此从B51转回。同理,B43:{B42↑,B41↓,B43↑}。
偶数模式下,首端调头转向角度行驶间隔跨度为q/2的地块,尾端调头转向角度行驶间隔跨度为q/2-1的地块。子分块B16子分块跨度为6,其转向顺序及方向为{B11↑,B14↓,B12↑,B15↓,B13↑,B16↓}。同理,B22:{B22↑,B21↓};B34:{B31↑,B33↓,B32↑,B34↓}。
根据本发明的一种实施方式,还包括步骤104。在步骤104,确定各分块直行行程和转向行程。
根据一种实施方式,可如下计算各分块直行行程:以子分块集B1第1条子分块B11直行行程SL1为基准,子分块B11直行行程可记为:SB11=SL1。第2条子分块B12直行行程在SL1基准上首尾各增加一段直行行程,分别记为d/tanα1和其中,子分块集B1中首尾两端分别为第1转向点和第8转向点。由此可递推子分块集B1直行行程如下:
根据几何关系可递推子分块集B2直行行程如下:
以此类推,子分块集Bp直行行程可同理计算。
各子分块Bpq直行作业行程可由下式计算:
式中,k1为子分块集Bp地头首端转向点序数,k2为子分块集Bp地头尾端转向点序数,maxp为子分块集Bp最大子分块序数。
根据一种实施方式,可如下计算各分块转向行程。
作业过程中首尾调头转弯半径与转向半径SCi/ai及拖拉机最小转弯半径rmin有关:首尾调头间隔跨度为1时,调头转弯半径与转向半径SCi/ai无关,转出转回时均为拖拉机最小转弯半径rmin。而首尾调头间隔跨度大于1时,首次调头转出半径为该转向点的转向半径SCi/ai,二次转回半径为拖拉机最小转弯半径rmin。同时,进入下一子分块时首尾两端转向方向与前一子方块相反,同一子分块首尾端转向方向相同。特别地,拖拉机在自动作业过程中,进入下一子分块时由转向控制单元发送反向转弯指令。
以子分块B11向子分块B14转向为例,子分块集B1转向点序数为1时对应的转向弧长为SC1,该子分块B14入轨半径为rmin,入轨弧长为rmin(π-α1),转向间直线段行程为2d/sinα1,由此可得子分块B11向子分块B14转向行程如下,记为N B1(1→4):
NB1(1→4)=SC1+rmin(π-α1)+2d/sinα1
子分块集B1转向角相等且子分块跨度q相等,因此转向非作业行程均相等,具体如下:
NB1=NB1(1→4)=NB1(2→5)=NB1(3→6)
同理,各子分块集Bp转向行程可由下式计算:
式中,SCk为子分块集Bp对应转向点Ak的转向弧长,k为转向点序数,a为子分块集Bp首次调头转出子分块序数,b为子分块集Bp二次转回子分块序数。
根据一种实施方式,本发明的作业区域路径规划方法还包括:行程规划图制作步骤105,根据所述转向模式、直行行程和转向行程制作行程规划图;以及显示步骤106,显示该行程规划图。图5示出了依据本发明的一种实施方式显示的实时行程规划图。路径图依据周边直行行程、转向行程、子分块执行行程、转向行程制作,用以直观方式显示整个作业区域以及各子分块。
下面结合附图介绍本发明实施方式的装置。对于本发明的装置和方法具有对应的部分,对装置的描述可以用来帮助理解上文的方法,对方法的描述可以用来理解本发明的装置。
图6示出了依据本发明的一种实施方式的作业区域路径规划装置的示意性方框图。
如图6所示,依据本发明的一种实施方式的作业区域路径规划装置包括:周边参数获取单元501,获得农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角;子分块作业行确定单元502,根据所述周边直线行程、周边转向行程以及各转向角,确定子分块以及子分块跨度;转向模式确定单元503,根据所述子分块跨度q的奇偶性,确定转向模式。
依据一种实施方式,所述转向模式确定单元如下地确定转向模式:当子分块跨度q为奇数时,该子分块首端调头转向时,所述农用机械按该段转向角度行驶到该子分块的序号为(q+1)/2的作业行;该子分块尾端调头转向时,所述农用机械按该段转向角度行驶到该子分块的序号为(q-1)/2的作业行;
当子分块跨度q为偶数时,首端调头时行驶到该子分块的序号q/2的作业行,尾端调头时行驶到该子分块的序号为q/2-1的作业行。
根据一种实施方式,该作业区域路径规划装置还包括:子分块直行行程确定单元504,确定各子分块的直行行程;转向行程确定单元505,确定各子分块的转向行程;行程规划图制作单元506,根据所述转向模式、所述直行行程和转向行程制作行程规划图;以及显示单元507,显示所述行程规划图。
图7示出了根据一种实施方式,转向行程确定单元的示意性方框图。如图7所示,依据本发明的一种实施方式,转向行程确定单元可以包括:转向半径确定单元601,确定转向半径,所述转向半径包括转出半径和转回半径,当首尾调头间隔跨度为1时,转向半径均为拖拉机最小转弯半径rmin;当首尾调头间隔跨度大于1时,首次调头转出半径为该转向点的转向半径SCi/ai,二次转回半径为拖拉机最小转弯半径rmin,其中SCi为该转向点的转向弧长,ai为该转向点的转向角;分块转向行程计算单元602,根据转向半径、转向弧长、转向角、有效作业宽度确定转向行程。可以根据上文描述的公式来计算转向行程。
在本发明的以上实施方式中,各物理量的单位如下:
直行车速信号VL(t):千米/时(km/h)
转向车速信号VC(t):千米/时(km/h)
采样频率f0、F0:赫兹(Hz)
最小转弯半径rmin:米(m)
转向半径SCi/ai:米(m)
转向弧长SCi:米(m)
转向角ai:弧度(rad)
直行直线行程:米(m)
转向弧线行程:米(m)
有效作业宽度d:米(m)
转向行程:米(m)
直行行程:米(m)
依据本发明的实施方式,细分了整体作业区域,使得不依赖GPS定位而获得作业区域面积和进行农用机械作业控制成为可能。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和替换,这些改进和替换也应视为本发明的保护范围。
Claims (10)
1.一种基于分块的作业区域路径规划方法,包括:
周边参数获取步骤,获得农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角;
子分块确定步骤,根据所述周边直线行程、周边转向行程以及各转向角,确定子分块以及子分块跨度;
转向模式确定步骤,根据所述子分块跨度q的奇偶性,确定转向模式,
其中,所述方法还包括:
子分块直行行程确定步骤,确定各子分块的直行行程;
子分块转向行程确定步骤,确定各子分块的转向行程;
行程规划图制作步骤,根据所述转向模式、所述直行行程和转向行程制作行程规划图;
其中,所述子分块转向行程计算步骤如下地确定转向行程:
式中,SCk 为子分块集B p 对应转向点A k 的转向弧长,k为转向点序数,a为子分块集B p 首次调头转出子分块序数,b为子分块集B p 二次转回子分块序数,d是有效作业宽度,a i 为转向点i的转向角;
所述子分块直行行程计算步骤如下地确定直行行程:
式中,k 1 为子分块集B p 地头首端转向点序数,k 2 为子分块集B p 地头尾端转向点序数,max p 为子分块集B p 最大子分块序数。
2.根据权利要求1所述的方法,其特征在于,所述子分块转向行程确定步骤包括:
转向半径确定步骤,确定转向半径,所述转向半径包括转出半径和转回半径,当首尾调头间隔跨度为1时,转向半径均为所述农用机械最小转弯半径rmin;当首尾调头间隔跨度大于1时,首次调头转出半径为该转向点的转向半径SCi /a i ,二次转回半径为所述农用机械最小转弯半径rmin,其中SCi 为该转向点的转向弧长,a i 为该转向点的转向角,
分块转向行程计算步骤,根据转向半径、转向弧长、转向角、有效作业宽度确定转向行程。
3.根据权利要求1所述的方法,其特征在于,在所述周边参数获取步骤中,利用实时车速记录仪与分时采集传感器协同工作,监测分时车速,包括直行车速和直行时间、转向车速和转向时间,并由转向角度传感器采集并记录转向角度,从而获得所述农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角。
5.根据权利要求1所述的方法,其特征在于,所述方法还包括显示步骤,用于显示所述行程规划图。
6.一种基于分块的作业区域路径规划装置,包括:
周边参数获取单元,获得农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角;
子分块确定单元,根据所述周边直线行程、周边转向行程以及各转向角,确定子分块以及子分块跨度;
转向模式确定单元,根据所述子分块跨度q的奇偶性,确定转向模式;
其中:
子分块直行行程确定单元,确定各子分块的直行行程;
子分块转向行程确定单元,确定各子分块的转向行程;
行程规划图制作单元,根据所述转向模式、所述直行行程和转向行程制作行程规划图;
其中,所述子分块转向行程计算单元如下地确定转向行程:
式中,SCk 为子分块集B p 对应转向点A k 的转向弧长,k为转向点序数,a为子分块集B p 首次调头转出子分块序数,b为子分块集B p 二次转回子分块序数,d是有效作业宽度,a i 为转向点i的转向角;
所述子分块直行行程计算单元如下地确定直行行程:
式中,k 1 为子分块集B p 地头首端转向点序数,k 2 为子分块集B p 地头尾端转向点序数,max p 为子分块集B p 最大子分块序数。
7.根据权利要求6所述的装置,其特征在于,其中,所述转向行程确定单元包括:
转向半径确定单元,确定转向半径,所述转向半径包括转出半径和转回半径,当首尾调头间隔跨度为1时,转向半径均为所述农用机械最小转弯半径rmin;当首尾调头间隔跨度大于1时,首次调头转出半径为该转向点的转向半径SCi /a i ,二次转回半径为所述农用机械最小转弯半径rmin,其中SCi 为该转向点的转向弧长,a i 为该转向点的转向角,
分块转向行程计算单元,根据转向半径、转向弧长、转向角、有效作业宽度确定转向行程。
8.根据权利要求7所述的装置,其特征在于,所述周边参数获取单元利用实时车速记录仪与分时采集传感器协同工作,监测分时车速,包括直行车速和直行时间、转向车速和转向时间,并由转向角度传感器采集并记录转向角度,从而获得所述农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角。
10.根据权利要求6所述的装置,其特征在于,所述装置还包括显示单元,用于显示所述行程规划图。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911196765.6A CN110843907B (zh) | 2017-12-11 | 2017-12-11 | 一种基于分块的作业区域路径规划方法及装置 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711304162.4A CN107985400B (zh) | 2017-12-11 | 2017-12-11 | 作业区域路径规划方法和装置 |
CN201911196765.6A CN110843907B (zh) | 2017-12-11 | 2017-12-11 | 一种基于分块的作业区域路径规划方法及装置 |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711304162.4A Division CN107985400B (zh) | 2017-12-11 | 2017-12-11 | 作业区域路径规划方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110843907A CN110843907A (zh) | 2020-02-28 |
CN110843907B true CN110843907B (zh) | 2021-03-23 |
Family
ID=62037168
Family Applications (3)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911196765.6A Active CN110843907B (zh) | 2017-12-11 | 2017-12-11 | 一种基于分块的作业区域路径规划方法及装置 |
CN201711304162.4A Active CN107985400B (zh) | 2017-12-11 | 2017-12-11 | 作业区域路径规划方法和装置 |
CN201911196822.0A Active CN110816655B (zh) | 2017-12-11 | 2017-12-11 | 基于作业行的作业区域路径规划方法 |
Family Applications After (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711304162.4A Active CN107985400B (zh) | 2017-12-11 | 2017-12-11 | 作业区域路径规划方法和装置 |
CN201911196822.0A Active CN110816655B (zh) | 2017-12-11 | 2017-12-11 | 基于作业行的作业区域路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (3) | CN110843907B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7089965B2 (ja) * | 2018-07-11 | 2022-06-23 | 株式会社クボタ | 作業車両 |
CN111624988A (zh) * | 2019-02-26 | 2020-09-04 | 北京合众思壮科技股份有限公司 | 掉头路径的规划方法和装置 |
CN112229415B (zh) * | 2020-11-03 | 2023-05-12 | 上海华测导航技术股份有限公司 | 路径规划方法、装置、电子设备和存储介质 |
CN115290095A (zh) * | 2022-09-28 | 2022-11-04 | 陕西耕辰科技有限公司 | 一种农机作业路径自动规划方法、系统、农机及存储介质 |
CN115511916A (zh) * | 2022-10-10 | 2022-12-23 | 未岚大陆(北京)科技有限公司 | 智能作业设备控制方法、装置、设备、介质及程序产品 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014178759A (ja) * | 2013-03-13 | 2014-09-25 | Kubota Corp | 作業車協調システム |
CN104781633A (zh) * | 2014-03-06 | 2015-07-15 | 日本集奥瑟甫有限公司 | 农田导航系统和农田导航方法及其软件和软件的存储设备 |
CN105684587A (zh) * | 2014-12-10 | 2016-06-22 | 井关农机株式会社 | 农用作业车辆 |
CN105980948A (zh) * | 2014-02-06 | 2016-09-28 | 洋马株式会社 | 自主行驶作业车辆的行驶路径的设定方法 |
CN106327024A (zh) * | 2016-09-18 | 2017-01-11 | 成都天麒科技有限公司 | 一种无人机农药喷洒路径规划系统及方法 |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
BR112015016674B1 (pt) * | 2013-01-11 | 2021-07-13 | Nissan Motor Co., Ltd. | Dispositivo de controle de exibição para veículos e método de controle de exibição para veículos |
DE102013009252A1 (de) * | 2013-06-03 | 2014-12-04 | Trw Automotive Gmbh | Steuergerät und Verfahren für eine Notfall-Lenkunterstützungsfunktion |
CN103699135B (zh) * | 2014-01-03 | 2016-04-06 | 中南大学 | 无人直升机农药喷洒农田作业区域的航迹自动规划方法 |
CN104503464B (zh) * | 2014-12-30 | 2017-01-18 | 中南大学 | 基于计算机的凸多边形农田无人机喷洒作业航迹规划方法 |
CN104808660B (zh) * | 2015-03-04 | 2017-10-03 | 中南大学 | 凹凸混合复杂多边形农田无人机喷洒作业航迹规划方法 |
CN104809519B (zh) * | 2015-04-29 | 2018-08-17 | 国家电网公司 | 一种计及电网拓扑优化的电力系统经济调度方法 |
CN107291073A (zh) * | 2016-04-01 | 2017-10-24 | 深圳市双目科技有限公司 | 一种基于自主作业的农业机器人系统、方法及其装置 |
CN107065919B (zh) * | 2016-12-14 | 2020-02-14 | 东北农业大学 | 农用植保无人机来回往复喷施过程中的转弯路径飞行控制方法、装置及无人机 |
CN106873620B (zh) * | 2017-02-22 | 2019-06-25 | 华中农业大学 | 基于工作单元按需独立启停的农用无人机精确控制方法 |
CN107036572B (zh) * | 2017-04-12 | 2019-07-23 | 中国农业大学 | 一种农机作业面积获取方法及装置 |
CN107390715A (zh) * | 2017-07-07 | 2017-11-24 | 深圳市华琥技术有限公司 | 一种基于无人机的喷药控制方法 |
-
2017
- 2017-12-11 CN CN201911196765.6A patent/CN110843907B/zh active Active
- 2017-12-11 CN CN201711304162.4A patent/CN107985400B/zh active Active
- 2017-12-11 CN CN201911196822.0A patent/CN110816655B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014178759A (ja) * | 2013-03-13 | 2014-09-25 | Kubota Corp | 作業車協調システム |
CN105980948A (zh) * | 2014-02-06 | 2016-09-28 | 洋马株式会社 | 自主行驶作业车辆的行驶路径的设定方法 |
CN104781633A (zh) * | 2014-03-06 | 2015-07-15 | 日本集奥瑟甫有限公司 | 农田导航系统和农田导航方法及其软件和软件的存储设备 |
CN105684587A (zh) * | 2014-12-10 | 2016-06-22 | 井关农机株式会社 | 农用作业车辆 |
CN106327024A (zh) * | 2016-09-18 | 2017-01-11 | 成都天麒科技有限公司 | 一种无人机农药喷洒路径规划系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107985400A (zh) | 2018-05-04 |
CN107985400B (zh) | 2020-09-18 |
CN110843907A (zh) | 2020-02-28 |
CN110816655A (zh) | 2020-02-21 |
CN110816655B (zh) | 2021-07-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110843907B (zh) | 一种基于分块的作业区域路径规划方法及装置 | |
CN109634276B (zh) | 农用车辆无人驾驶控制方法、系统及该农用车辆 | |
CN106355927B (zh) | Gps标记点确定方法、轨迹优化方法及装置 | |
US20210302962A1 (en) | Harvester, Harvesting System, Harvesting Method, Harvesting Program and Recording Medium | |
EP3489624B1 (en) | Automatic calibration method of angle sensor for automatic drive control system of farm machine | |
CN110160541A (zh) | 运动轨迹的重构方法和装置、存储介质、电子装置 | |
CN109115225A (zh) | 一种无人作业谷物联合收割机导航方法与导航装置 | |
JP6697955B2 (ja) | 作業車及び作業車に適用される時間ベース管理システム | |
US20210240192A1 (en) | Estimation method and estimator for sideslip angle of straight-line navigation of agricultural machinery | |
CN107977520B (zh) | 作业区域面积确定方法及装置 | |
JP5269118B2 (ja) | 列車走行実績データ作成システム | |
JP7020643B2 (ja) | 協調作業システム | |
CN111137298B (zh) | 一种车辆自动驾驶方法、装置、系统和存储介质 | |
EP2718500A1 (de) | Verfahren und vorrichtung zum bestimmen einer von mindestens einer baumaschine oder abbaumaschine mit einer fräswalze gefrästen fläche | |
EP3072025A1 (en) | System and method for automatically generating vehicle guidance waypoints and waylines | |
CN108873906A (zh) | 碾压工程车无人驾驶控制方法和装置及可读存储介质 | |
US20070268067A1 (en) | Method and Device for Acquiring a Position of a Motor Vehicle on a Road | |
Schönberg et al. | Positioning an autonomous off-road vehicle by using fused DGPS and inertial navigation | |
US20200301436A1 (en) | Autonomous travel vehicle and route generation method thereof | |
CA3171524A1 (en) | System and method facilitating travel of an electric off-road vehicle on an uncharted route | |
CN201494472U (zh) | 铁路机车调车用测距仪 | |
CN208477374U (zh) | 一种农机自动化ab线系统 | |
CN109727332A (zh) | 一种计算环卫车辆环卫作业次数的方法及系统 | |
Li et al. | Auxiliary navigation system based on Baidu Map JavaScript API for high clearance sprayers | |
CN115328135A (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 | ||
CB02 | Change of applicant information |
Address after: 241080 16 e - Xi Road, San Shan Economic Development Zone, Wuhu, Anhui Applicant after: Zhonglian Agricultural Machinery Co., Ltd Address before: 241080 Anhui province Wuhu City mountain Economic Development Zone E Xi Road No. 16 Applicant before: ZOOMLION HEAVY MACHINERY Co.,Ltd. |
|
CB02 | Change of applicant information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |