一种基于分块的作业区域路径规划方法及装置制造方法及图纸

技术编号:23438097 阅读:42 留言:0更新日期:2020-02-28 14:47
本发明专利技术涉及一种基于分块的作业区域路径规划方法及装置。该方法包括:周边参数获取步骤,获得农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角;子分块确定步骤,根据所述周边直线行程、周边转向行程以及各转向角,确定子分块以及子分块跨度;转向模式确定步骤,根据所述子分块跨度q的奇偶性,确定转向模式,其中,所述方法还包括:子分块直行行程确定步骤,确定各子分块的直行行程;子分块转向行程确定步骤,确定各子分块的转向行程;行程规划图制作步骤,根据所述转向模式、所述直行行程和转向行程制作行程规划图。

A path planning method and device of work area based on block

【技术实现步骤摘要】
一种基于分块的作业区域路径规划方法及装置本专利技术是申请号为201711304162.4、申请日为2017年12月11日、专利技术名称为“作业区域路径规划方法和装置”的专利技术申请的分案申请。
本专利技术涉及农业机械自动化
,更具体地涉及一种作业区域路径规划方法及装置。
技术介绍
在拖拉机组田间作业过程中,作业人员常根据经验和一些常识性规则进行田间作业路径设计,存在重耕、漏耕、多走路程等问题,影响作业生产效率。利用拖拉机自动作业技术能够有效减少相邻作业行间的重叠和遗漏,是提高农田作业质量和效率、降低作业成本的重要技术手段。对于拖拉机全覆盖自动作业系统,必须给定明确的田间作业路径,才能进行正常的行走和作业,全覆盖自动作业路径规划设计具有重大意义。目前,以全球定位系统(GPS)为代表的全球导航卫星系统(GNSS)技术应用逐渐满足农业生产对于静态定位或者动态定位的精度要求,它能够在作业前采集作业区域的地理信息,对作业路径进行合理规划;在作业过程中,控制拖拉机转向、加减速、制动等动作;而在完成田间作业后,对作业过程和作业效果进行评本文档来自技高网...

【技术保护点】
1.一种基于分块的作业区域路径规划方法,包括:/n周边参数获取步骤,获得农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角;/n子分块确定步骤,根据所述周边直线行程、周边转向行程以及各转向角,确定子分块以及子分块跨度;/n转向模式确定步骤,根据所述子分块跨度q的奇偶性,确定转向模式,/n其中,所述方法还包括:/n子分块直行行程确定步骤,确定各子分块的直行行程;/n子分块转向行程确定步骤,确定各子分块的转向行程;/n行程规划图制作步骤,根据所述转向模式、所述直行行程和转向行程制作行程规划图;/n其中,所述子分块转向行程计算步骤如下地确定转向行程:/n

【技术特征摘要】
1.一种基于分块的作业区域路径规划方法,包括:
周边参数获取步骤,获得农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角;
子分块确定步骤,根据所述周边直线行程、周边转向行程以及各转向角,确定子分块以及子分块跨度;
转向模式确定步骤,根据所述子分块跨度q的奇偶性,确定转向模式,
其中,所述方法还包括:
子分块直行行程确定步骤,确定各子分块的直行行程;
子分块转向行程确定步骤,确定各子分块的转向行程;
行程规划图制作步骤,根据所述转向模式、所述直行行程和转向行程制作行程规划图;
其中,所述子分块转向行程计算步骤如下地确定转向行程:



式中,SCk为子分块集Bp对应转向点Ak的转向弧长,k为转向点序数,a为子分块集Bp首次调头转出子分块序数,b为子分块集Bp二次转回子分块序数,d是有效作业宽度,ai为转向点i的转向角;
所述子分块直行行程计算步骤如下地确定直行行程:



式中,k1为子分块集Bp地头首端转向点序数,k2为子分块集Bp地头尾端转向点序数,maxp为子分块集Bp最大子分块序数。


2.根据权利要求1所述的方法,其特征在于,所述子分块转向行程确定步骤包括:
转向半径确定步骤,确定转向半径,所述转向半径包括转出半径和转回半径,当首尾调头间隔跨度为1时,转向半径均为所述农用机械最小转弯半径rmin;当首尾调头间隔跨度大于1时,首次调头转出半径为该转向点的转向半径SCi/ai,二次转回半径为所述农用机械最小转弯半径rmin,其中SCi为该转向点的转向弧长,ai为该转向点的转向角,
分块转向行程计算步骤,根据转向半径、转向弧长、转向角、有效作业宽度确定转向行程。


3.根据权利要求1所述的方法,其特征在于,在所述周边参数获取步骤中,利用实时车速记录仪与分时采集传感器协同工作,监测分时车速,包括直行车速和直行时间、转向车速和转向时间,并由转向角度传感器采集并记录转向角度,从而获得所述农用机械在预定作业区域的周边直线行程、周边转向行程以及各周边直线行程和周边转向行程之间的转向角。


4.根据权利要求3所述的方法,其特征在于,在所述周边参数获取步骤中,如下地计算各段的直行行程以及转向行程:
所述农业机械沿作业区域边界直行时,实时车速记录仪按特定分时采样频率f0采集直行车速信号VL(t),按特定分时采样频率F0采集转向车速信号VC(t),同时转向角度传感器记录转向角度ai,通过拟合分时车速-时间函数,可计算得到该直线行程为转向行程为式中m、n均为采样序数,重复上述步骤,可计算获得各段的直行行程SLi及转向行程SCi。


5.根据权利要求1所述的方法,其特征在于,所述方法还包括显示步骤,用于显示所述行程规划图。...

【专利技术属性】
技术研发人员:唐明
申请(专利权)人:中联重机股份有限公司
类型:发明
国别省市:安徽;34

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1