CN109094562A - 一种无人驾驶拖拉机协同作业间距控制装置及控制方法 - Google Patents

一种无人驾驶拖拉机协同作业间距控制装置及控制方法 Download PDF

Info

Publication number
CN109094562A
CN109094562A CN201810971976.1A CN201810971976A CN109094562A CN 109094562 A CN109094562 A CN 109094562A CN 201810971976 A CN201810971976 A CN 201810971976A CN 109094562 A CN109094562 A CN 109094562A
Authority
CN
China
Prior art keywords
tractor
safe distance
situation
ecu
mcu
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.)
Pending
Application number
CN201810971976.1A
Other languages
English (en)
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.)
Luoyang Zhongke Smart Equipment Technology Co Ltd
Original Assignee
Luoyang Zhongke Smart Equipment Technology Co Ltd
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 Luoyang Zhongke Smart Equipment Technology Co Ltd filed Critical Luoyang Zhongke Smart Equipment Technology Co Ltd
Priority to CN201810971976.1A priority Critical patent/CN109094562A/zh
Publication of CN109094562A publication Critical patent/CN109094562A/zh
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/14Adaptive cruise control
    • B60W30/16Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

一种无人驾驶拖拉机协同作业间距控制装置及控制方法,装置:多个红外激光测距传感器组将采集后测得的多组数据传送给MCU;转向角度传感器用于检测车辆处于直行或转向状态,并将检测信号传送给MCU;MCU用于根据同一位置的多组数据进行对比进而得出准确的距离数据,并根据车辆直行或转向状态将准确的距离数据分别与直线安全距离的设定值或转向安全距离的设定值进行比较,并根据比较情况向ECU发出加速信号或减速以及停车信号。方法:设定安全距离值;计算实际车距h;判断车辆行驶状态;比较h与直行或转向安全距离。该装置和方法能控制相邻无人拖拉机的间距,能避免无人驾驶拖拉机由于多辆无人驾驶拖拉机协同工作间距导常引起的安全事故。

Description

一种无人驾驶拖拉机协同作业间距控制装置及控制方法
技术领域
本发明属于无人拖拉机驾驶技术领域,尤其是涉及一种无人驾驶拖拉机协同作业间距控制装置及控制方法。
背景技术
在农业生产中,拖拉机是主要应用的农用机械,然而现今的农村面临着务农人员外流严重的问题,农村劳动力严重不足,甚至出现了农用机械无人操作的状况,而无人驾驶的农用机械可以有效解决无人操作的难题。现阶段,市场已经研发出了无人驾驶拖拉机,同时,在地域广阔的一些地区,已经出现了多辆无人拖拉机并排协同作业的工况,多辆无人拖拉机协同作业可以大大的提高工作效率,但是在作业过程中,相邻两辆无人拖拉机的间距控制一直是一个难题,间距控制不好,会影响作业质量,甚至会引起其他安全生产事故。
发明内容
针对上述技术问题,本发明提供一种无人驾驶拖拉机协同作业间距控制装置及控制方法,该装置可以有效控制相邻无人拖拉机的间距,能够有效避免无人驾驶拖拉机由于不合适的间距引起的安全事故,该方法能在无人驾驶拖拉机间的距离不在安全范围内,会及时调节拖拉机的速度,从而使无人拖拉机间距能维持在一个比较安全的距离范围内。
为了实现上述目的,本发明采用的技术方案是:一种无人驾驶拖拉机协同作业间距控制装置,包括多个红外激光测距传感器组、转向角度传感器和MCU;
多个红外激光测距传感器组沿拖拉机外轮廓表面布置,每个红外激光测距传感器组由布置在同一位置的若干个红外激光测距传感器组成,用于将采集后测得的同一位置的多组数据传送给MCU;
所述转向角度传感器安装在拖拉机上,用于检测车辆处于直行或转向状态,并将检测信号传送给MCU;
所述MCU设置在拖拉机上,MCU用于根据同一位置的多组数据进行对比进而得出准确的距离数据,并根据车辆直行或转向状态将准确的距离数据分别与直线安全距离的设定值或转向安全距离的设定值进行比较,并根据比较情况向ECU发出加速信号、减速或停车信号;
所述拖拉机的ECU根据收到的加速信号、减速信号或者停车信号来控制喷油量,以控制发动机的转速。
进一步,为了保证通信的可靠性,所述MCU通过CAN总线与ECU连接。
本发明采用红外激光测距传感器采集相邻拖拉机之间的实时距离,红外激光测距传感器具有精确度高,响应时间短,相互干扰小,可同时进行多个传感器测量的优点,所采集实时距离信息由MCU进行处理,MCU将实时距离与安全值进行比较判断是否停车、加速或减速,以实现在无人参与的情况下实现多辆无人驾驶拖拉机的自主地协同工作。在多辆无人驾驶拖拉机协同作业时,每辆车辆进行运动状态调节不需要同时联动其它车辆,利用该装置能避免多辆无人驾驶拖拉机在协同作业时,因外界作业环境多变而引发的安全事故。
本发明还提供了一种无人驾驶拖拉机协同作业间距控制方法,具体包括以下步骤;
S1:设定安全距离值,根据预先重复测试的情况,设定直行安全距离的最小值d1和最大值d2,设定转向安全距离的最小值d3和最大值d4
S2:计算实际车距h,通过红外激光测距传感器组实时测量与相邻的拖拉机之间的距离获得;
S3:判断车辆行驶状态,通过转向角度传感器判断出车辆处于直行或转向状态,直行状态执行S4,转向状态执行S5;
S4:比较h与直行安全距离值,当d1≤h≤d2时,保持直行状态不变,并依次执行S2和S3;当h<d1时,分两种情况:一种情况是与相邻的拖拉机运动方向相同时,此时,通过ECU控制拖拉机减速或者停车,以增大安全距离;另一种情况是与相邻的拖拉机运动方向相反时,此时,通过ECU控制拖拉机加速行驶,以增大安全距离;
当h>d2时,分两种情况:一种情况是与相邻的拖拉机运动方向相同时,此时,通过ECU控制拖拉机加速行驶,以缩小车辆距离来维持合适的安全距离;另一种情况是与相邻的拖拉机运动方向相反时,此时,通过ECU控制拖拉机减速,以缩小车辆距离来维持合适的安全距离;
S5:比较h与转向安全距离值,当d3≤h≤d4时,保持转向状态不变,并依次执行S2和S3;当h<d3,分两种情况:一种情况是与相邻的拖拉机运动方向相同时,此时,通过ECU控制拖拉机减速或者停车,以增大安全距离;另一种情况是与相邻的拖拉机运动方向相反时,此时,通过ECU控制拖拉机加速行驶,以增大安全距离;
当h>d4,分两种情况:一种情况是与相邻的拖拉机运动方向相同时,此时,通过ECU控制拖拉机加速行驶,以缩小车辆距离来维持合适的安全距离;另一种情况是与相邻的拖拉机运动方向相反时,此时,通过ECU控制拖拉机减速,以缩小车辆距离来维持合适的安全距离。
进一步,为了能在发生偏移时有足够的时间和空间采取相应的安全措施,在S2中h通过以下方法测得:先由安装在拖拉机上同一位置的一个红外激光测距传感器组测出多个测量值,为保证车辆安全,取其中与该组数据平均值偏差不超过5%的最小值得到。
进一步,为了能够充分的保证有足够的调节时间应对复杂的路况,在S1中d3>d1,d4>d2
本发明基于红外激光测距传感器采集距离数据信息,通过MCU计算相邻拖拉机之间距离,并与设定安全值进行比较,采用经典反馈机制来调整车辆的间距,提供了一种无人拖拉机自主判断安全距离及采取相应安全措施保证多台无人驾驶拖拉机均在安全范围内进行稳定耕作的控制方法。该方法在无人驾驶拖拉机间的距离不在安全距离范围内就会调节相关拖拉机的速度,从而使无人拖拉机间距维持在一个比较安全的距离范围内。
附图说明
图1是本发明中电路部分的原理框图。
图2是本发明中红外激光测距传感器的安装示意图;
图3是相邻拖拉机间测距的示意图;
图4是本发明中的流程图。
图中:1、拖拉机,2、红外激光测距传感器。
具体实施方式
下面结合附图对本发明作进一步说明。
图1表明了无人驾驶拖拉机协同作业间距控制装置系统关系,图2是红外激光测距传感器组安装示意;图3相邻拖拉机间测距的示意。本发明提供一种无人驾驶拖拉机协同作业间距控制装置,包括多个红外激光测距传感器组2、转向角度传感器和MCU;
多个红外激光测距传感器组2沿拖拉机1外轮廓表面布置,每个红外激光测距传感器组2由布置在同一位置的若干个红外激光测距传感器组成,用于将采集后测得的同一位置的多组数据传送给MCU;
所述转向角度传感器安装在拖拉机1上,用于检测车辆处于直行或转向状态,并将检测信号传送给MCU;
所述MCU设置在拖拉机1上,MCU用于根据同一位置的多组数据进行对比进而得出准确的距离数据,并根据车辆直行或转向状态将准确的距离数据分别与直线安全距离的设定值或转向安全距离的设定值进行比较,并根据比较情况向ECU发出加速信号、减速或停车信号;
所述拖拉机1具有ECU,所述ECU根据收到的加速信号、减速信号或者停车信号来控制喷油量,以控制发动机的转速。
为了保证通信的可靠性,所述MCU通过CAN总线与ECU连接。
如图3和图4所示,一种无人驾驶拖拉机协同作业间距控制方法,具体包括以下步骤;
S1:设定安全距离值,根据预先重复测试的情况,设定直行安全距离的最小值d1和最大值d2,设定转向安全距离的最小值d3和最大值d4
S2:计算实际车距h,通过红外激光测距传感器组2实时测量与相邻的拖拉机1之间的距离获得;h通过以下方法测得:先由安装在拖拉机1上同一位置的一个红外激光测距传感器组2测出多个测量值,为保证车辆安全,取其中与该组数据平均值偏差不超过5%的最小值得到。
S3:判断车辆行驶状态,通过转向角度传感器判断出车辆处于直行或转向状态,直行状态执行S4,转向状态执行S5;
S4:比较h与直行安全距离值,当d1≤h≤d2时,保持直行状态不变,并依次执行S2和S3;当h<d1时,分两种情况:一种情况是与相邻的拖拉机1运动方向相同时,与拖拉机1运动方向相同的方向出现了安全距离缩小的情况则是由于车速过快造成的,此时,通过ECU控制拖拉机1减速或者停车,以增大安全距离;另一种情况是与相邻的拖拉机1运动方向相反时,此时,通过ECU控制拖拉机1加速行驶,以增大安全距离;
当h>d2时,分两种情况:一种情况是与相邻的拖拉机1运动方向相同时,此时,通过ECU控制拖拉机1加速行驶,以缩小车辆距离来维持合适的安全距离;另一种情况是与相邻的拖拉机1运动方向相反时,此时,通过ECU控制拖拉机1减速,以缩小车辆距离来维持合适的安全距离;
S5:比较h与转向安全距离值,当d3≤h≤d4时,保持转向状态不变,并依次执行S2和S3;当h<d3,分两种情况:一种情况是与相邻的拖拉机1运动方向相同时,与拖拉机1运动方向相同的方向出现了安全距离缩小的情况则是由于车速过快造成的,此时,通过ECU控制拖拉机1减速或者停车,以增大安全距离;另一种情况是与相邻的拖拉机1运动方向相反时,此时,通过ECU控制拖拉机1加速行驶,以增大安全距离;
当h>d4,分两种情况:一种情况是与相邻的拖拉机1运动方向相同时,此时,通过ECU控制拖拉机1加速行驶,以缩小车辆距离来维持合适的安全距离;另一种情况是与相邻的拖拉机1运动方向相反时,此时,通过ECU控制拖拉机1减速,以缩小车辆距离来维持合适的安全距离。
为了能够充分的保证有足够的调节时间应对复杂的路况,在S1中d3>d1,d4>d2
本发明采用红外激光测距传感器采集相邻拖拉机之间的实时距离,红外激光测距传感器具有精确度高,响应时间短,相互干扰小,可同时进行多个传感器同步测量的优点,所采集实时距离信息由MCU进行处理,MCU将实时距离与安全值进行比较判断是否停车、加速或减速,以实现在无人参与的情况下实现多辆无人驾驶拖拉机的自主地协同工作。在多辆无人驾驶拖拉机协同作业时,每辆车辆进行运动状态调节不需要同时联动其它车辆,利用该装置能避免多辆无人驾驶拖拉机在协同作业时,因外界作业环境多变(比如有车快,有车慢,有车需要急停,有车需要转弯等情况造成的拖拉机之间距离小于安全距离等情况。)而引发的安全事故。同时,本发明提供了一种拖拉机自主判断安全距离及采取相应安全措施保证多台无人驾驶拖拉机均在安全范围内进行稳定耕作的控制方法。

Claims (5)

1.一种无人驾驶拖拉机协同作业间距控制装置,包括多个红外激光测距传感器组(2),其特征在于,还包括转向角度传感器和MCU;
多个红外激光测距传感器组(2)沿拖拉机(1)外轮廓表面布置,每个红外激光测距传感器组(2)由布置在同一位置的若干个红外激光测距传感器组成,用于将采集后测得的同一位置的多组数据传送给MCU;
所述转向角度传感器安装在拖拉机(1)上,用于检测车辆处于直行或转向状态,并将检测信号传送给MCU;
所述MCU设置在拖拉机(1)上,MCU用于根据同一位置的多组数据进行对比进而得出准确的距离数据,并根据车辆直行或转向状态将准确的距离数据分别与直线安全距离的设定值或转向安全距离的设定值进行比较,并根据比较情况向ECU发出加速信号、减速或停车信号;
所述拖拉机(1)的ECU根据收到的加速信号、减速信号或者停车信号来控制喷油量,以控制发动机的转速。
2.根据权利要求1所述的一种无人驾驶拖拉机协同作业间距控制装置,其特征在于,所述MCU通过CAN总线与ECU连接。
3.一种无人驾驶拖拉机协同作业间距控制方法,其特征在于,具体包括以下步骤;
S1:设定安全距离值,根据预先重复测试的情况,设定直行安全距离的最小值d1和最大值d2,设定转向安全距离的最小值d3和最大值d4
S2:计算实际车距h,通过红外激光测距传感器组(2)实时测量与相邻的拖拉机(1)之间的距离获得;
S3:判断车辆行驶状态,通过转向角度传感器判断出车辆处于直行或转向状态,直行状态执行S4,转向状态执行S5;
S4:比较h与直行安全距离值,当d1≤h≤d2时,保持直行状态不变,并依次执行S2和S3;当h<d1时,分两种情况:一种情况是与相邻的拖拉机(1)运动方向相同时,此时,通过ECU控制拖拉机(1)减速或者停车,以增大安全距离;另一种情况是与相邻的拖拉机(1)运动方向相反时,此时,通过ECU控制拖拉机(1)加速行驶,以增大安全距离;
当h>d2时,分两种情况:一种情况是与相邻的拖拉机(1)运动方向相同时,此时,通过ECU控制拖拉机(1)加速行驶,以缩小车辆距离来维持合适的安全距离;另一种情况是与相邻的拖拉机(1)运动方向相反时,此时,通过ECU控制拖拉机(1)减速,以缩小车辆距离来维持合适的安全距离;
S5:比较h与转向安全距离值,当d3≤h≤d4时,保持转向状态不变,并依次执行S2和S3;当h<d3,分两种情况:一种情况是与相邻的拖拉机(1)运动方向相同时,此时,通过ECU控制拖拉机(1)减速或者停车,以增大安全距离;另一种情况是与相邻的拖拉机(1)运动方向相反时,此时,通过ECU控制拖拉机(1)加速行驶,以增大安全距离;
当h>d4,分两种情况:一种情况是与相邻的拖拉机(1)运动方向相同时,此时,通过ECU控制拖拉机(1)加速行驶,以缩小车辆距离来维持合适的安全距离;另一种情况是与相邻的拖拉机(1)运动方向相反时,此时,通过ECU控制拖拉机(1)减速,以缩小车辆距离来维持合适的安全距离。
4.根据权利要求3所述的一种无人驾驶拖拉机协同作业间距控制方法,其特征在于,在S2中h通过以下方法测得:先由安装在拖拉机(1)上同一位置的一个红外激光测距传感器组(2)测出多个测量值,为保证车辆安全,取其中与该组数据平均值偏差不超过5%的最小值得到。
5.根据权利要求4所述的一种无人驾驶拖拉机协同作业间距控制方法,其特征在于,在S1中d3>d1,d4>d2
CN201810971976.1A 2018-08-24 2018-08-24 一种无人驾驶拖拉机协同作业间距控制装置及控制方法 Pending CN109094562A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810971976.1A CN109094562A (zh) 2018-08-24 2018-08-24 一种无人驾驶拖拉机协同作业间距控制装置及控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810971976.1A CN109094562A (zh) 2018-08-24 2018-08-24 一种无人驾驶拖拉机协同作业间距控制装置及控制方法

Publications (1)

Publication Number Publication Date
CN109094562A true CN109094562A (zh) 2018-12-28

Family

ID=64851338

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810971976.1A Pending CN109094562A (zh) 2018-08-24 2018-08-24 一种无人驾驶拖拉机协同作业间距控制装置及控制方法

Country Status (1)

Country Link
CN (1) CN109094562A (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN205034112U (zh) * 2015-09-02 2016-02-17 郑州宇通客车股份有限公司 一种汽车自主驾驶系统
CN106950954A (zh) * 2017-03-15 2017-07-14 普倩萌 一种多农业机器人的控制方法及系统
CN107117167A (zh) * 2017-04-24 2017-09-01 南京航空航天大学 具有多种避撞模式的汽车差速转向系统及其控制方法
CN107226089A (zh) * 2017-04-14 2017-10-03 南京航空航天大学 一种无人驾驶汽车避撞策略
WO2017187929A1 (ja) * 2016-04-26 2017-11-02 ヤンマー株式会社 作業車両制御システム
JP2017211733A (ja) * 2016-05-24 2017-11-30 ヤンマー株式会社 自律走行経路生成システム
CN107472243A (zh) * 2016-06-06 2017-12-15 本田技研工业株式会社 车辆和变更车道时间判定方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN205034112U (zh) * 2015-09-02 2016-02-17 郑州宇通客车股份有限公司 一种汽车自主驾驶系统
WO2017187929A1 (ja) * 2016-04-26 2017-11-02 ヤンマー株式会社 作業車両制御システム
JP2017211733A (ja) * 2016-05-24 2017-11-30 ヤンマー株式会社 自律走行経路生成システム
CN107472243A (zh) * 2016-06-06 2017-12-15 本田技研工业株式会社 车辆和变更车道时间判定方法
CN106950954A (zh) * 2017-03-15 2017-07-14 普倩萌 一种多农业机器人的控制方法及系统
CN107226089A (zh) * 2017-04-14 2017-10-03 南京航空航天大学 一种无人驾驶汽车避撞策略
CN107117167A (zh) * 2017-04-24 2017-09-01 南京航空航天大学 具有多种避撞模式的汽车差速转向系统及其控制方法

Similar Documents

Publication Publication Date Title
CN104290753B (zh) 一种前方车辆运动状态追踪预测装置及其预测方法
CN108278981A (zh) 检测无人驾驶挂车轴偏角的装置及其检测方法
CN205049180U (zh) 一种公路超限检测系统
CN106292664A (zh) 一种变电站巡检机器人导航控制系统及方法
CN103640622A (zh) 一种基于驾驶员模型的汽车方向智能控制方法及控制系统
CN105774655B (zh) 一种倾斜车位探测装置及方法
CN104627068B (zh) 一种自动泊车过程中车身航向角的计算方法
CN107572373A (zh) 基于机器视觉的新型起重机主动防斜拉控制系统及其控制方法
CN111025250A (zh) 一种车载毫米波雷达在线标定方法
CN204490038U (zh) 一种矿用布料轮车精确定位与控制系统
CN103991351A (zh) 液压平板车载重平台四点支撑调平系统及其实现方法
CN207345797U (zh) 车辆侧翻预警控制系统以及车辆
CN208282792U (zh) 检测无人驾驶挂车轴偏角的装置
CN116238545B (zh) 一种自动驾驶轨迹偏差检测方法及检测系统
CN101886910A (zh) 双前桥车轮车桥平行定位调整方法
CN110763142A (zh) 一种慢速运动车辆外廓尺寸测量方法
CN109839175A (zh) 一种桥梁活载优化识别系统
CN108313125A (zh) 一种转向角传感器的校准方法和装置
CN105509946A (zh) 一种辨识飞机升降舵效率的方法
CN110988829B (zh) 一种基于uwb定位的车辆传感器标定方法及系统
CN110244002B (zh) 一种基于无人机系统的大气污染源追踪方法
CN206787497U (zh) 一种在线检测平面油膜厚度的装置
CN111625021A (zh) 一种基于电磁场的无人机电力巡线测距系统及方法
CN109094562A (zh) 一种无人驾驶拖拉机协同作业间距控制装置及控制方法
CN110703253B (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
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20181228