CN106502252A - 多传感器融合的拖拉机导航控制系统及其定位、控制方法 - Google Patents

多传感器融合的拖拉机导航控制系统及其定位、控制方法 Download PDF

Info

Publication number
CN106502252A
CN106502252A CN201611103085.1A CN201611103085A CN106502252A CN 106502252 A CN106502252 A CN 106502252A CN 201611103085 A CN201611103085 A CN 201611103085A CN 106502252 A CN106502252 A CN 106502252A
Authority
CN
China
Prior art keywords
module
controller
tractor
host computer
data
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
CN201611103085.1A
Other languages
English (en)
Other versions
CN106502252B (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.)
Shandong Shuangli Modern Agricultural Equipment Co ltd
Original Assignee
Liaocheng 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 Liaocheng University filed Critical Liaocheng University
Priority to CN202310911519.4A priority Critical patent/CN116795119A/zh
Priority to CN201611103085.1A priority patent/CN106502252B/zh
Priority to CN202310911514.1A priority patent/CN117008170A/zh
Publication of CN106502252A publication Critical patent/CN106502252A/zh
Application granted granted Critical
Publication of CN106502252B publication Critical patent/CN106502252B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/22—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01L—MEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01R—MEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
    • G01R19/00—Arrangements for measuring currents or voltages or for indicating presence or sign thereof
    • G01R19/25—Arrangements for measuring currents or voltages or for indicating presence or sign thereof using digital measurement techniques
    • G01R19/2503—Arrangements for measuring currents or voltages or for indicating presence or sign thereof using digital measurement techniques for measuring voltage only, e.g. digital volt meters (DVM's)
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/393—Trajectory determination or predictive tracking, e.g. Kalman filtering
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/52—Determining velocity

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

本发明公开了多传感器融合的拖拉机导航控制系统及其定位、控制方法，包括上位机、下位机，上位机和下位机通过串口通信模块相互连接，上位机连接触摸屏、北斗定位接收模块、图像采集模块、位姿检测模块、串口通信模块；下位机连接数据存储模块、压力检测模块、CAN通信模块、换向阀控制模块、电压检测模块、车速检测模块、车轮转角检测模块、电源模块、报警及紧急处理模块和串口通信模块，液压转向系统分别与压力检测模块和换向阀控制模块相连接，电压检测模块还与换向阀控制模块相连接。本发明还提供了该系统的定位、控制方法，具有精确的车辆定位和路径跟踪性能。

Description

多传感器融合的拖拉机导航控制系统及其定位、控制方法
技术领域
本发明涉及拖拉机自动导航领域，具体地讲，是多传感器融合的拖拉机导航控制系统及其定位、控制方法。
背景技术
目前的农业作业中，通常由驾驶员独自操作，劳动强度大且重复单调，容易使人疲劳并产生误操作。农机自动导航技术是精细农业的一项重要技术，该技术可以自动获得导航路径并控制农业机械沿着目标路径行驶，辅助驾驶员操作农业机械进行作业。拖拉机自动导航是农业现代化的重要基础，实现拖拉机自动导航可以让农业作业者降低工作强度，并且能显著地提高农机的作业精度，提高农田的土地利用率，降低生产成本，提高作物产量与经济效益，将劳动者从繁重的农田作业中解放出来。
拖拉机导航技术在北美、日本和欧洲一些国家中研究起步较早，并取得了较多研究成果，国内的专家学者也做了广泛的研究，取得了一定的成果。如申请号为2014101751440的发明专利公开了一种对射式激光拖拉机辅助导航控制系统，授权号101833334A的发明专利公开了一种拖拉机自动导航控制系统及其方法，申请号为104656647A的发明专利公开了一种低矮作物田间自走拖拉机导航控制系统等。可以看出，采用的都是单一导航定位技术，比如GPS导航、激光发射导航技术等，每种导航方式各有优点，但是因单一导航技术受条件限制都存在一定的使用条件，很难能够提供连续、稳定高质量的定位信息；另外，目前拖拉机路径跟踪控制算法中，大多都仅仅将拖拉机航向角和偏移量做为被控量或参考量，但没有考虑到选取了拖拉机预估路径曲度和当前行驶速度；导致现有的技术方案往往只能保证直线行驶时的控制效果，而很难保证曲线行驶或拐弯时的路径跟踪效果。
发明内容
本发明要解决的技术问题是提供多传感器融合的拖拉机导航控制系统及其定位、控制方法，具有精确的车辆定位和路径跟踪性能。
本发明采用如下技术方案实现发明目的：
一种多传感器融合的拖拉机导航控制系统，包括上位机和下位机，所述的上位机和下位机通过串口通信模块相互连接，实现拖拉机位置的精准定位和设定路径的精确跟踪；上位机连接触摸屏、北斗定位接收模块、图像采集模块、位姿检测模块、串口通信模块；下位机连接数据存储模块、压力检测模块、CAN通信模块、换向阀控制模块、电压检测模块、车速检测模块、车轮转角检测模块、电源模块、报警及紧急处理模块和串口通信模块。
(1)本技术方案中导航控制系统通过采用北斗定位和机器视觉定位相结合的方式，能够实现两种导航技术的优势互补，可以避免使用单一定位造成的车辆位置误差；组合导航功能既可以用在有作物的农田作业中也可以用在无作物的农田中，组合导航定位技术在可靠性、准确性等方面都较单独导航情况要好。(2)采用双天线的北斗信号接收装置，并且采用位姿检测模块的数据对北斗定位信息进行修正，得到的拖拉机位置数据更精确；(3)不仅选取了拖拉机当前航线偏移量、当前航向角偏移量，而且选取了拖拉机预估路径曲度和参考车速进行处理，使导航控制系统具有良好的路径控制效果。
拖拉机当前航线偏移量、当前航向角偏移量、拖拉机预估路径曲度值由上位机通过北斗导航数据或图像数据计算输出；拖拉机参考车速VU(s)由上位机发送的车速VR(s)和车速采集VM(s)决定，按照如下公式确定：
因拖拉机在低速行驶时，通过北斗导航获得的行驶速度其准确度低于车速检测模块获得的车速，所以在确定车速时，如果车速检测模块采集的车速VM(s)小于等于2公里/秒或接收的上位机的车速VR(s)等于0时，则确定的参考车速为VM(s)，这样可以避免因北斗导航在低速或故障时造成的速度误差；当车速检测模块采集的车速VM(s)大于2公里/秒或车速检测模块出现故障时，确定参考车速为上位机发送车速VR(s)。
作为对本技术方案的进一步限定：
换向阀控制模块分别与电压检测模块和液压转向系统电连接。
压力检测模块还与液压转向系统电连接。
上位机采用EPCS-8980型工控机。
触摸屏选用四线电阻式触摸屏SV0804S-03。
北斗定位接收模块采用UM220模块。
图像采集模块由OKAC1310CCD摄像头和信号调理电路组成。
位姿检测模块选用AHRS-3000小型航姿测量模块。
下位机采用16位飞思卡尔单片机MC9S12XS128MAL。
数据存储模块采用两片32MB的SDRAM MT48LC4M32B2数据存储芯片。
压力检测模块由压力传感器MBS1250和信号调理电路组成。
CAN通信模块由TJA1043T芯片与其外围电路组成，通过该模块，下位机能够将根据预估行驶距离和预估路径曲度确定的拖拉机期望速度发送给拖拉机控制器，确保在拖拉机行驶至终点或拐弯时的控制效果，特别在当前航线偏移量OR(s)超过可允许最大航线偏移量OM时，通过该模块给拖拉机控制器发送停车信号。
换向阀控制模块由D/A转换芯片DAC0832、运算放大器LM358N及外围电路组成。
电压检测模块由运算放大器AD741和外围电路组成。
通过设计电压检测模块，能够对换向阀控制模块的输出电压实施闭环控制，通过实时检测输出电压，避免输出电压失控现象发生。
车速检测模块由测速传感器VB-Z9400及信号调理电路组成。
车轮转角检测模块由线位移传感器HPS-M1和信号调理电路组成。
电源模块由产生24V电压芯片LT4356IS、产生5V电压芯片LM7805、产生正负15电压芯片MD20-12D15、产生10V电压芯片AD581及外围电路组成。
串口通信模块由串口通信芯片MAX232芯片及其外围电路组成。
报警及紧急处理模块由喇叭、发光灯、光耦和继电器等组成。报警和紧急处理模块能够在液压阀运行至最大或当曲线路径弯度过大时发出报警信息并启动相应的紧急响应动作。
上位机通过串口通信模块发送给下位机用于路径跟踪的数据包括：当前航线偏移量、当前航向角偏移量、预估行驶距离、当前行驶速度、预估路径曲度。
多传感器融合的拖拉机导航控制系统的定位方法，通过上位机进行拖拉机定位，包括如下步骤：
(1)通过触摸屏设定拖拉机工作田间模式：无农作物田地，有农作物田地；
(2)采用双天线的北斗接收装置，用北斗定位接收模块获取拖拉机的绝对位置、行驶速度和航向角信息；
(3)采用位姿检测模块获取拖拉机的航向角、横滚角、俯仰角数据，并依据这些数据对北斗定位信息进行修正；
(4)如果田间模式设定为无农作物田地，则关闭图像采集模块，不采用机器视觉定位方式；如果田间模式设定为有农作物田地，则开启图采集模块，对采集图像数据进行处理，并生成导航基准线、获取表征农作物特征的基本点。
(5)如果田间模式设定为无农作物田地，则完全采用经过位姿信息修正的北斗定位和路径数据；如果田间模式设定为有农作物田地，则采用模糊自适应扩展卡尔曼滤波器对北斗定位数据和机器视觉数据进行融合，其中北斗定位提供拖拉机的绝对位置坐标、航向角度和行驶速度，机器视觉提供导航路径中已知点的相对位置坐标，北斗定位系统和机器视觉系统坐标统一后，由滤波器对北斗提供的位置数据和机器视觉提供的位置数据进行滤波，得到精确的位置数据和路径数据。
与目前多传感器融合技术中常用的扩展卡尔曼滤波器和无迹卡尔曼滤波器相比，模糊自适应扩展卡尔曼滤波算法能够通过实时得到的测量新息方差和理论方差的比值，并利用模糊自适应控制器不断调整量测噪声协方差阵的加权系数，减少校正位置误差，提高拖拉机定位数据的准确性和稳定性。
一种多传感器融合的拖拉机导航控制系统的控制方法，控制方法为路径跟踪控制，包括如下步骤：
(1)路径跟踪控制系统采用串级控制结构进行设计，其中主回路采取前馈加反馈控制方法，副回路采用单位负反馈方法，整个系统结构由偏移量设定值OS(s)、当前航线偏移量OR(s)、偏移量控制器CO(s)、转角控制器CS(s)、换向阀控制器CV(s)、电压采集VM(s)、转向系统G(s)、预估路径曲度PCR(s)、当前航向角偏移量AR(s)、航向角控制器CA(s)、车轮转角反馈A(s)、上位机发送的车速VR(s)、车速采集VM(s)、参考车速VU(s)组成；
(2)主回路中的反馈控制器为偏移量控制器CO(s)，其设定值输入为偏移量设定值OS(s)和当前航线偏移量OR(s)的差值，偏移量控制器CO(s)的输出为转向角度θFB，通过如下公式计算：
其中ΔO＝OS(s)-OR(s)，KFB1为偏移量控制器比例系数，KFB2为偏移量控制器微分系数，KFB3为偏移量控制器二阶微分系数。因拖拉机路径跟踪的直接控制量是航线偏移量，本发明通过对偏移量差值实施比例、微分和二阶微分的控制，可减少控制过程中的超调，克服振荡现象发生；通过设定可允许最大航线偏移量OM，可使拖拉机在航线偏差超过可允许范围时不再继续执行转向，并且控制偏移量控制器输出为0，避免损坏液压阀或安全事故发生；
(3)主回路中的前馈控制器为航向角控制器CA(s)，其参考输入为预估路径曲度PCR(s)、当前航向角偏移量AR(s)和当前航线偏移量OR(s)，航向角控制器CA(s)的输出为转向角度θFF，通过如下公式计算：
其中KFF1为航向角控制器路径曲度控制比例系数，KFF2为航向角控制器比例系数，KFF3为航向角控制器微分比例系数。在航线偏移量允许值OP范围内，通过将航向角作为参考量，可实施预先控制，减少路径跟踪过程的波动；将预估路径曲度作为参考量，可实现曲线行驶或拐弯时的预先控制，提高非直线路径的跟踪效果。
(4)副回路控制器为转角控制器CS(s)，其设定值为θFB与θFF之和与车轮转角反馈A(s)的差值，参考输入量为车轮转角反馈A(s)和参考车速VU(s)，其中参考车速VU(s)由上位机发送的车速VR(s)和车速采集VM(s)决定，按照如下公式确定参考车速：
转角控制器CS(s)的输出为车轮转角设定值θ，通过如下公式计算：
其中Kθ为转角控制器CS(s)的比例系数。因拖拉机在低速行驶时，通过北斗导航获得的行驶速度其准确度低于车速检测模块获得的车速，所以在确定车速时，如果车速检测模块采集的车速VM(s)小于等于2公里/秒或接收的上位机的车速VR(s)等于0时，则确定的参考车速为VM(s)，这样可以避免因北斗导航在低速或故障时造成的速度误差；当车速检测模块采集的车速VM(s)大于2公里/秒或车速检测模块出现故障时，确定参考车速为上位机发送车速VR(s)。将车速信号作为确定车轮转角设定值的参数，可减少系统调整时间；
(5)换向阀控制器CV(s)的设定值为车轮转角设定值θ，其通过换向阀控制模块输出负10V至正10V范围的电压控制液压转向系统实施转向。
与现有技术相比，本发明在控制量和参考量设定时，不仅选取了拖拉机当前航线偏移量、当前航向角偏移量，而且选取了拖拉机预估路径曲度和当前行驶速度，提出的拖拉机路径跟踪串级控制结构，主回路采取前馈加反馈控制方法，副回路采取单位负反馈方法，该控制方法不仅保证直线行驶时的路径跟踪效果，而且在拐弯时也具有很高的控制精度。
附图说明
图1为本发明的原理框图。
图2为本发明所采用的控制方法结构示意图。
图3为本发明的换向阀控制模块的电路原理图。
图4为本发明的电压检测模块的电路原理图。
图5为本发明的车速检测模块的电路原理图。
图6为本发明的转角检测模块的电路原理图。
附图标记说明：1-触摸屏；2-数据存储模块；3-压力检测模块；4-北斗定位接收模块；5-上位机；6-报警及紧急处理模块；7-下位机；8-CAN通信模块；9-图像采集模块；10-串口通信模块；11-换向阀控制模块；12-液压转向系统；13-拖拉机；14-位姿检测模块；15-电源模块；16-车速检测模块；17-车轮转角检测模块；18-电压检测模块。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。此处所描述的具体实施例仅用以解释本发明，并不用于限定本发明。本发明涵盖任何由权利要求定义的在本发明的精髓和范围上做的替代、修改、等效方法及方案。为了使公众对本发明有更好的了解，在具体实施方式中对本发明的细节描述中，详尽描述了一些特定的细节部分，对于未描述的部分，均为本领域技术的常规技术。
结合图1、图2可知，本发明实施例提供了一种多传感器融合的拖拉机导航控制系统，由上位机5和下位机7组成，上位机5和下位机7通过串口通信模块10相互连接，实现拖拉机13位置的精准定位和设定路径的精确跟踪；上位机5连接触摸屏1、北斗定位接收模块4、图像采集模块9、位姿检测模块14、串口通信模块10；下位机7连接数据存储模块2、压力检测模块3、CAN通信模块8、换向阀控制模块11、电压检测模块18、车速检测模块16、车轮转角检测模块17、电源模块15、报警及紧急处理模块6和串口通信模块10；换向阀控制模块11分别与电压检测模块18和液压转向系统12电连接，压力检测模块3还与液压转向系统12电连接。
本发明中上位机5选用EPCS-8980型工控机，它是整个导航系统中进行车辆位置信息处理的核心部件以及人机对话的中心，与触摸屏1结合完成田间模式设定、导航参数配置、路径下载、导航任务设定、路径规划、车辆运行轨迹实时显示等功能。
触摸屏1与上位机5通过功能引脚相互连接，作为拖拉机13作业时的人机交互界面，可实现导航模式选择、导航参数输入和车辆运行轨迹显示等功能，方便操作人员对拖拉机13导航系统工作状态进行判断，本发明选用四线电阻式触摸屏1SV0804S-03。
北斗定位接收模块4与上位机5通过串行通信引脚相互连接，本发明采用UM220模块接收北斗卫星信号用来确定车辆位置，因采用的是北斗常规接收技术，在此不再赘述。
图像采集模块9与上位机5通过串行通信引脚相互连接，由OKAC1310CCD摄像头采集农作物图像，经过信号调理电路后经串口送至上位机5，经灰度变换、图像分割、图像去噪后提取出导航基准线，确定导航路径特征值。
位姿检测模块14与上位机5通过串行通信引脚相互连接，选用AHRS-3000小型航姿测量模块将拖拉机13动静态环境下的横滚角、俯仰角和航向角通过串口发送至上位机5，上位机5利用这些参数对北斗定位数据进行补偿，可减少或避免因受地面起伏影响车体产生倾斜而导航的定位误差。
下位机7采用16位飞思卡尔单片机MC9S12XS128MAL，是拖拉机13路径跟踪控制的核心，通过串口通信模块10接收上位机5发送的拖拉机13位置信息并经过控制运算后，由换向阀控制模块11输出电压信号实现对液压转向系统12的控制。
数据存储模块2，采用两片32MB的SDRAM MT48LC4M32B2，分别与飞思卡尔单片机通过功能引脚相互连接，用于存储导航状态信息和控制输出信息，方便后期对导航系统工作效果进行评估和分析。
压力检测模块3与下位机7和液压转向系统12电连接，用于判断拖拉机13的驾驶模式，由安装在导航阀组上的压力传感器MBS1250检测阀组压力并转换成电压信号送至下位机7的数字量输入口，传感器输出低压信号表示拖拉机13处于自动导航模式，传感器输出高压信号表示拖拉机13处于人工驾驶模式。
CAN通信模块8由TJA1043T芯片与其外围电路组成，通过该模块，下位机7能够将根据预估行驶距离和预估路径曲度确定的拖拉机13期望速度发送给拖拉机13控制器，确保在拖拉机13行驶至终点或拐弯时的控制效果，特别在当前航线偏移量OR(s)超过可允许最大航线偏移量OM时，通过该模块给拖拉机13控制器发送停车信号。
结合图3可知，换向阀控制模块11分别与电压检测模块18和液压转向系统12电连接，选用D/A转换芯片DAC0832输出0-255的数字量，该数字量经过放大器U18-U21产生正10V至负10V范围内的电压用于控制换向电磁阀，实现对液压转向系统12的控制。本发明选用4WRA6E20-10B/24Z4型号的比例方向阀。
结合图4可知，电压检测模块18由运算放大器和外围电路组成，通过设计电压检测模块，能够对换向阀控制模块11的输出电压实施闭环控制，通过实时检测输出电压，避免输出电压失控现象发生。
结合图5可知，车速检测模块16与下位机7的中断输入口相连接，该模块由测速传感器和调理电路组成，测速传感器选用VB-Z9400霍尔转速传感器，它通过感应导磁体上凸起的齿或是凹下的槽，输出方波信号，该方波信号经过四分之一个LM339和电阻R38,R39,R40构成的滞回比较电路去除噪声干扰，送至下位机7的外部中断引脚，下位机7通过下降沿触发的外部中断方式对车速信号进行捕捉。
结合图6可知，车轮转角检测模块17与下位机7电连接，该模块用于完成对车轮转角的实时检测，选用HPS-M1型线位移传感器将车轮转角信号转换成电压信号后经过电阻R13和电容C11滤波后进入放大器U12的反向输入端，放大器U12的正向输入端经电阻R15接地，U12的输出端经电阻R14后接入其反向输入端，同时U12的输出端经电阻R16后接入放大器U13的反向输入端，放大器U13的同向输入端经电阻R18后接地，U13的输出端经电阻R17后接入其反向输入端，同时与下位机7的模拟量输入口PA5相接。
电源模块15与下位机7电连接，由车载蓄电池供电，分别经过LT4356IS电路和LM7805电路产生24V防浪涌电压和5V电压，经过MD20-12D15模块产生正负15的电压，经过AD581产生10V的基准电压，为保证下位机7系统的供电电压不至于过高或过低，设计了电源监控保护电路。
串口通信模块10分别与上位机5和下位机7相连接，该模块由串口通信芯片MAX232芯片及其外围电路组成，通过串口通信模块10可完成下位机7和上位机5的数据交换。
报警及紧急处理模块6与下位机7电连接，用于在液压阀运行至最大或当曲线路径弯度过大时，下位机7可以控制继电器打开，使与蜂鸣器和发光灯相连的引脚为高电平，发出报警信息，并且控制输出电压为零使换向阀回归中心位置，同时置位手动模式。
上位机5通过串口通信模块10发送给下位机7用于路径跟踪的数据包括：当前航线偏移量、当前航向角偏移量、预估行驶距离、当前行驶速度、预估路径曲度。
多传感器融合的拖拉机导航控制系统的定位方法，通过上位机5对拖拉机13进行定位，包括如下步骤：
(1)通过触摸屏1设定拖拉机13工作田间模式：无农作物田地，有农作物田地；
(2)采用双天线的北斗接收装置，用北斗定位接收模块4获取拖拉机13的绝对位置、行驶速度和航向角信息；
(3)采用位姿检测模块14获取拖拉机13的航向角、横滚角、俯仰角数据，并依据这些数据对北斗定位信息进行修正；
(4)如果田间模式设定为无农作物田地，则关闭图像采集模块9，不采用机器视觉定位方式；如果田间模式设定为有农作物田地，则开启图像采集模块9，对采集图像数据进行处理，并生成导航基准线、获取表征农作物特征的基本点。
(5)如果田间模式设定为无农作物田地，则完全采用经过位姿信息修正的北斗定位和路径数据；如果田间模式设定为有农作物田地，则采用模糊自适应扩展卡尔曼滤波器对北斗定位数据和机器视觉数据进行融合，其中北斗定位提供拖拉机13的绝对位置坐标、航向角度和行驶速度，机器视觉提供导航路径中已知点的相对位置坐标，北斗定位系统和机器视觉系统坐标统一后，由滤波器对北斗提供的位置数据和机器视觉提供的位置数据进行滤波，得到精确的位置数据和路径数据。
与目前多传感器融合技术中常用的扩展卡尔曼滤波器和无迹卡尔曼滤波器相比，模糊自适应扩展卡尔曼滤波算法能够通过实时得到的测量新息方差和理论方差的比值，并利用模糊自适应控制器不断调整量测噪声协方差阵的加权系数，减少校正位置误差，提高拖拉机13定位数据的准确性和稳定性。
一种多传感器融合的拖拉机导航控制系统的控制方法，控制方法为路径跟踪控制，包括如下步骤：
(1)路径跟踪控制系统采用串级控制结构进行设计，其中主回路采取前馈加反馈控制方法，副回路采用单位负反馈方法，整个系统结构由偏移量设定值OS(s)、当前航线偏移量OR(s)、偏移量控制器CO(s)、转角控制器CS(s)、换向阀控制器CV(s)、电压采集VM(s)、转向系统G(s)、预估路径曲度PCR(s)、当前航向角偏移量AR(s)、航向角控制器CA(s)、车轮转角反馈A(s)、上位机5发送的车速VR(s)、车速采集VM(s)、参考车速VU(s)组成；
(2)主回路中的反馈控制器为偏移量控制器CO(s)，其设定值输入为偏移量设定值OS(s)和当前航线偏移量OR(s)的差值，偏移量控制器CO(s)的输出为转向角度θFB，通过如下公式计算：
其中ΔO＝OS(s)-OR(s)，KFB1为偏移量控制器比例系数，KFB2为偏移量控制器微分系数，KFB3为偏移量控制器二阶微分系数。因拖拉机13路径跟踪的直接控制量是航线偏移量，本发明通过对偏移量差值实施比例、微分和二阶微分的控制，可减少控制过程中的超调，克服振荡现象发生；通过设定可允许最大航线偏移量OM，可使拖拉机13在航线偏差超过可允许范围时不再继续执行转向，并且控制偏移量控制器输出为0，避免损坏液压阀或安全事故发生；
(3)主回路中的前馈控制器为航向角控制器CA(s)，其参考输入为预估路径曲度PCR(s)、当前航向角偏移量AR(s)和当前航线偏移量OR(s)，航向角控制器CA(s)的输出为转向角度θFF，通过如下公式计算：
其中KFF1为航向角控制器路径曲度控制比例系数，KFF2为航向角控制器比例系数，KFF3为航向角控制器微分比例系数。在航线偏移量允许值OP范围内，通过将航向角作为参考量，可实施预先控制，减少路径跟踪过程的波动；将预估路径曲度作为参考量，可实现曲线行驶或拐弯时的预先控制，提高非直线路径的跟踪效果。
(4)副回路控制器为转角控制器CS(s)，其设定值为θFB与θFF之和与车轮转角反馈A(s)的差值，参考输入量为车轮转角反馈A(s)和参考车速VU(s)，其中参考车速VU(s)由上位机5发送的车速VR(s)和车速采集VM(s)决定，按照如下公式确定参考车速：
转角控制器CS(s)的输出为车轮转角设定值θ，通过如下公式计算：
其中Kθ为转角控制器CS(s)的比例系数。因拖拉机13在低速行驶时，通过北斗导航获得的行驶速度其准确度低于车速检测模块16获得的车速，所以在确定车速时，如果车速检测模块16采集的车速VM(s)小于等于2公里/秒或接收的上位机5的车速VR(s)等于0时，则确定的参考车速为VM(s)，这样可以避免因北斗导航在低速或故障时造成的速度误差；当车速检测模块16采集的车速VM(s)大于2公里/秒或车速检测模块16出现故障时，确定参考车速为上位机5发送车速VR(s)。将车速信号作为确定车轮转角设定值的参数，可减少系统调整时间。
(5)换向阀控制器CV(s)的设定值为车轮转角设定值θ，其通过换向阀控制模块11输出负10V至正10V范围的电压控制液压转向系统12实施转向。
与现有技术相比，本发明在控制量和参考量设定时，不仅选取了拖拉机13当前航线偏移量、当前航向角偏移量，而且选取了拖拉机13预估路径曲度和当前行驶速度。提出的拖拉机13路径跟踪串级控制结构，主回路采取前馈加反馈控制方法，副回路采取单位负反馈方法，该控制方法不仅保证直线行驶时的路径跟踪效果，而且在拐弯时也具有很高的控制精度。
最后应说明的是：以上所述仅为本发明的优选实施例而已，并不用于限制本发明，尽管参照前述实施例对本发明进行了详细的说明，对于本领域的技术人员来说，其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (4)

1.一种多传感器融合的拖拉机导航控制系统，包括上位机和下位机，其特征在于：所述的上位机和下位机通过串口通信模块相互连接，共同实现拖拉机位置精准定位和设定路径的精确跟踪；上位机连接触摸屏、北斗定位接收模块、图像采集模块、位姿检测模块、串口通信模块；下位机连接数据存储模块、压力检测模块、CAN通信模块、换向阀控制模块、电压检测模块、车速检测模块、车轮转角检测模块、电源模块、报警及紧急处理模块和串口通信模块；所述的换向阀控制模块分别与电压检测模块和液压转向系统电连接；所述的压力检测模块还与液压转向系统电连接。
2.根据权利要求1所述的一种多传感器融合的拖拉机导航控制系统，其特征在于：所述的上位机通过串口通信模块发送给下位机用于路径跟踪的数据包括：当前航线偏移量、当前航向角偏移量、预估行驶距离、当前行驶速度、预估路径曲度。
3.根据权利要求1所述的一种多传感器融合的拖拉机导航控制系统的定位方法，其特征在于：通过上位机对拖拉机进行定位，包括如下步骤：
(1)通过触摸屏设定拖拉机工作田间模式：无农作物田地，有农作物田地；
(2)采用双天线的北斗接收装置，用北斗定位接收模块获取拖拉机的绝对位置、行驶速度和航向角信息；
(3)采用位姿检测模块获取拖拉机的航向角、横滚角、俯仰角数据，并依据这些数据对北斗定位信息进行修正；
(4)如果田间模式设定为无农作物田地，则关闭图像采集模块，不采用机器视觉定位方式；如果田间模式设定为有农作物田地，则开启图采集模块，对采集图像数据进行处理，并生成导航基准线、获取表征农作物特征的基本点；
(5)如果田间模式设定为无农作物田地，则完全采用经过位姿信息修正的北斗定位和路径数据；如果田间模式设定为有农作物田地，则采用模糊自适应扩展卡尔曼滤波器对北斗定位数据和机器视觉数据进行融合，生成精确的拖拉机位置数据和路径规划数据。
4.根据权利要求1所述的一种多传感器融合的拖拉机导航控制系统的控制方法，其特征在于，控制方法为路径跟踪控制，包括如下步骤：
(1)路径跟踪控制系统采用串级控制结构进行设计，其中主回路采取前馈加反馈控制方法，副回路采取单位负反馈方法，整个系统结构由偏移量设定值OS(s)、当前航线偏移量OR(s)、偏移量控制器CO(s)、转角控制器CS(s)、换向阀控制器CV(s)、电压采集VM(s)、转向系统G(s)、预估路径曲度PCR(s)、当前航向角偏移量AR(s)、航向角控制器CA(s)、车轮转角反馈A(s)、上位机发送的车速VR(s)、车速采集VM(s)、参考车速VU(s)组成；
(2)主回路中的反馈控制器为偏移量控制器CO(s)，其设定值输入为偏移量设定值OS(s)和当前航线偏移量OR(s)的差值，偏移量控制器CO(s)的输出为转向角度θFB，通过如下公式计算：
其中ΔO＝OS(s)-OR(s)，KFB1为偏移量控制器比例系数，KFB2为偏移量控制器微分系数，KFB3为偏移量控制器二阶微分系数；
(3)主回路中的前馈控制器为航向角控制器CA(s)，其参考输入为预估路径曲度PCR(s)、当前航向角偏移量AR(s)和当前航线偏移量OR(s)，航向角控制器CA(s)的输出为转向角度θFF，通过如下公式计算：
其中KFF1为航向角控制器路径曲度控制比例系数，KFF2为航向角控制器比例系数，KFF3为航向角控制器微分比例系数；
(4)副回路控制器为转角控制器CS(s)，其设定值为θFB与θFF之和与车轮转角反馈A(s)的差值，参考输入量为车轮转角反馈A(s)和参考车速VU(s)，其中参考车速VU(s)由上位机发送的车速VR(s)和车速采集VM(s)决定，按照如下公式确定参考车速：
V U ( s ) = V M ( s ) ( V M ( s ) ≤ 2 ) ∪ ( V R ( s ) = 0 ) V R ( s ) ( V M ( s ) > 2 ) ∪ ( ( V M ( s ) = 0 ) ∩ ( V R ( s ) ≠ 0 ) )
转角控制器CS(s)的输出为车轮转角设定值θ，通过如下公式计算：
其中Kθ为转角控制器CS(s)的比例系数；
(5)换向阀控制器CV(s)的设定值为车轮转角设定值θ，其通过换向阀控制模块输出负10V至正10V范围的电压控制液压转向系统实现转向。
CN201611103085.1A 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的控制方法 Active CN106502252B (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN202310911519.4A CN116795119A (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的定位与控制方法
CN201611103085.1A CN106502252B (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的控制方法
CN202310911514.1A CN117008170A (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611103085.1A CN106502252B (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的控制方法

Related Child Applications (2)

Application Number Title Priority Date Filing Date
CN202310911514.1A Division CN117008170A (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的定位方法
CN202310911519.4A Division CN116795119A (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的定位与控制方法

Publications (2)

Publication Number Publication Date
CN106502252A true CN106502252A (zh) 2017-03-15
CN106502252B CN106502252B (zh) 2024-02-02

Family

ID=58330456

Family Applications (3)

Application Number Title Priority Date Filing Date
CN202310911519.4A Pending CN116795119A (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的定位与控制方法
CN202310911514.1A Pending CN117008170A (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的定位方法
CN201611103085.1A Active CN106502252B (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的控制方法

Family Applications Before (2)

Application Number Title Priority Date Filing Date
CN202310911519.4A Pending CN116795119A (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的定位与控制方法
CN202310911514.1A Pending CN117008170A (zh) 2016-12-05 2016-12-05 多传感器融合的拖拉机导航控制系统的定位方法

Country Status (1)

Country Link
CN (3) CN116795119A (zh)

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107450537A (zh) * 2017-08-01 2017-12-08 南京农业大学 一种履带式联合收割机低速作业直线跟踪方法
CN107884593A (zh) * 2017-10-27 2018-04-06 江苏大学 一种以拖拉机为动力的农业机具速度监测系统与方法
CN107972732A (zh) * 2017-12-04 2018-05-01 安徽农业大学 一种无人驾驶插秧机自动转向控制系统及其控制方法
CN108669046A (zh) * 2018-05-16 2018-10-19 中国农业大学 融合视觉导航与北斗定位的植保无人车及控制方法
CN109508007A (zh) * 2018-12-11 2019-03-22 东南大学 一种基于多源信息融合的农机轨迹跟踪、避障系统及方法
CN109857098A (zh) * 2018-12-11 2019-06-07 东南大学 一种基于mpc的自动驾驶农机轨迹跟踪系统及方法
CN110007667A (zh) * 2018-01-04 2019-07-12 中国农业机械化科学研究院 一种履带拖拉机及其路径跟踪控制方法和系统
CN110018502A (zh) * 2019-03-07 2019-07-16 清博（昆山）智能科技有限公司 一种卫星定位修正方法
CN111578942A (zh) * 2020-04-29 2020-08-25 中国农业大学 一种平地机导航方法和系统
CN111845712A (zh) * 2020-07-28 2020-10-30 聊城大学 一种拖拉机防侧翻控制系统及其控制方法
CN113589815A (zh) * 2021-08-02 2021-11-02 华中农业大学 一种基于变增益单神经元pid的秸秆旋埋还田导航系统
CN114485680A (zh) * 2021-08-10 2022-05-13 华中农业大学 一种秸秆旋埋还田导航系统设计与试验方法
CN114771656A (zh) * 2022-05-11 2022-07-22 山东理工大学 一种拖拉机前轮转向角测量方法及系统
CN114771656B (zh) * 2022-05-11 2024-06-21 山东理工大学 一种拖拉机前轮转向角测量方法及系统

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2009100463A1 (en) * 2008-02-10 2009-08-13 Hemisphere Gps Llc Visual, gnss and gyro autosteering control
CN101833334A (zh) * 2010-02-09 2010-09-15 北京农业信息技术研究中心 拖拉机自动导航控制系统及其方法
US20110022267A1 (en) * 2009-07-21 2011-01-27 Trimble Navigation Limited Agricultural Vehicle Autopilot Rollover Risk Assessment System
CN101976079A (zh) * 2010-08-27 2011-02-16 中国农业大学 智能导航控制系统及方法
CN102252681A (zh) * 2011-04-18 2011-11-23 中国农业大学 基于gps和机器视觉的组合导航定位系统及方法
CN102506852A (zh) * 2011-11-01 2012-06-20 丁幼春 农用车辆视觉导航系统及其导航方法
CN103673937A (zh) * 2013-11-11 2014-03-26 安徽赛为信息技术有限责任公司 一种双重算法模式农机田作业面积的计算系统及其方法
CN103901833A (zh) * 2012-12-28 2014-07-02 中国科学院沈阳自动化研究所 一种农机田间作业管理与监控的车载计算机及其方法
RU2550915C1 (ru) * 2013-11-19 2015-05-20 Юрий Феликсович Черняков Трактор точного хода и способ автопилотирования машинно-тракторного агрегата по местным ориентирам
CN104793616A (zh) * 2015-03-25 2015-07-22 西北农林科技大学 一种农业收获机器人的夜视导航系统
CN204576265U (zh) * 2015-05-06 2015-08-19 聊城大学 一种基于北斗系统的拖拉机自动导航控制系统
CN105799776A (zh) * 2016-04-22 2016-07-27 扬州大学 基于北斗导航的农业机械自动驾驶耕作控制系统及方法
CN105865461A (zh) * 2016-04-05 2016-08-17 武汉理工大学 一种基于多传感器融合算法的汽车定位系统及方法

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2009100463A1 (en) * 2008-02-10 2009-08-13 Hemisphere Gps Llc Visual, gnss and gyro autosteering control
US20110022267A1 (en) * 2009-07-21 2011-01-27 Trimble Navigation Limited Agricultural Vehicle Autopilot Rollover Risk Assessment System
CN101833334A (zh) * 2010-02-09 2010-09-15 北京农业信息技术研究中心 拖拉机自动导航控制系统及其方法
CN101976079A (zh) * 2010-08-27 2011-02-16 中国农业大学 智能导航控制系统及方法
CN102252681A (zh) * 2011-04-18 2011-11-23 中国农业大学 基于gps和机器视觉的组合导航定位系统及方法
CN102506852A (zh) * 2011-11-01 2012-06-20 丁幼春 农用车辆视觉导航系统及其导航方法
CN103901833A (zh) * 2012-12-28 2014-07-02 中国科学院沈阳自动化研究所 一种农机田间作业管理与监控的车载计算机及其方法
CN103673937A (zh) * 2013-11-11 2014-03-26 安徽赛为信息技术有限责任公司 一种双重算法模式农机田作业面积的计算系统及其方法
RU2550915C1 (ru) * 2013-11-19 2015-05-20 Юрий Феликсович Черняков Трактор точного хода и способ автопилотирования машинно-тракторного агрегата по местным ориентирам
CN104793616A (zh) * 2015-03-25 2015-07-22 西北农林科技大学 一种农业收获机器人的夜视导航系统
CN204576265U (zh) * 2015-05-06 2015-08-19 聊城大学 一种基于北斗系统的拖拉机自动导航控制系统
CN105865461A (zh) * 2016-04-05 2016-08-17 武汉理工大学 一种基于多传感器融合算法的汽车定位系统及方法
CN105799776A (zh) * 2016-04-22 2016-07-27 扬州大学 基于北斗导航的农业机械自动驾驶耕作控制系统及方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
刘兆祥;刘刚;籍颖;张漫;孟志军;付卫强;: "基于自适应模糊控制的拖拉机自动导航系统", 农业机械学报, no. 11, pages 154 - 158 *

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107450537A (zh) * 2017-08-01 2017-12-08 南京农业大学 一种履带式联合收割机低速作业直线跟踪方法
CN107884593B (zh) * 2017-10-27 2020-09-25 江苏大学 一种以拖拉机为动力的农业机具速度监测系统与方法
CN107884593A (zh) * 2017-10-27 2018-04-06 江苏大学 一种以拖拉机为动力的农业机具速度监测系统与方法
CN107972732A (zh) * 2017-12-04 2018-05-01 安徽农业大学 一种无人驾驶插秧机自动转向控制系统及其控制方法
CN110007667A (zh) * 2018-01-04 2019-07-12 中国农业机械化科学研究院 一种履带拖拉机及其路径跟踪控制方法和系统
CN108669046A (zh) * 2018-05-16 2018-10-19 中国农业大学 融合视觉导航与北斗定位的植保无人车及控制方法
CN109508007A (zh) * 2018-12-11 2019-03-22 东南大学 一种基于多源信息融合的农机轨迹跟踪、避障系统及方法
CN109857098A (zh) * 2018-12-11 2019-06-07 东南大学 一种基于mpc的自动驾驶农机轨迹跟踪系统及方法
CN110018502A (zh) * 2019-03-07 2019-07-16 清博（昆山）智能科技有限公司 一种卫星定位修正方法
CN111578942A (zh) * 2020-04-29 2020-08-25 中国农业大学 一种平地机导航方法和系统
CN111578942B (zh) * 2020-04-29 2022-04-05 中国农业大学 一种平地机导航方法和系统
CN111845712A (zh) * 2020-07-28 2020-10-30 聊城大学 一种拖拉机防侧翻控制系统及其控制方法
CN111845712B (zh) * 2020-07-28 2022-02-01 聊城大学 一种拖拉机防侧翻控制系统的控制方法
CN113589815A (zh) * 2021-08-02 2021-11-02 华中农业大学 一种基于变增益单神经元pid的秸秆旋埋还田导航系统
CN114485680A (zh) * 2021-08-10 2022-05-13 华中农业大学 一种秸秆旋埋还田导航系统设计与试验方法
CN114771656A (zh) * 2022-05-11 2022-07-22 山东理工大学 一种拖拉机前轮转向角测量方法及系统
CN114771656B (zh) * 2022-05-11 2024-06-21 山东理工大学 一种拖拉机前轮转向角测量方法及系统

Also Published As

Publication number Publication date
CN117008170A (zh) 2023-11-07
CN116795119A (zh) 2023-09-22
CN106502252B (zh) 2024-02-02

Similar Documents

Publication Publication Date Title
CN106502252A (zh) 多传感器融合的拖拉机导航控制系统及其定位、控制方法
US6445983B1 (en) Sensor-fusion navigator for automated guidance of off-road vehicles
CN102393744B (zh) 一种无人驾驶汽车的导航方法
CN102789233B (zh) 基于视觉的组合导航机器人及导航方法
CN102506852B (zh) 农用车辆视觉导航系统及其导航方法
CN102368158B (zh) 一种果园机械导航定位方法
CN109115225A (zh) 一种无人作业谷物联合收割机导航方法与导航装置
CN105928531A (zh) 一种适用于无人驾驶汽车的行进路线精准生成方法
CN101866181A (zh) 农用机械的导航方法、导航装置和农用机械
CN107015238A (zh) 基于三维激光雷达的无人车自主定位方法
CN113359710B (zh) 一种基于los理论的农机路径跟踪方法
CN105987696A (zh) 一种低成本车辆自动驾驶设计实现方法
CN110220529A (zh) 一种路侧自动驾驶车辆的定位方法
CN206696705U (zh) 基于模糊控制的农机车载导航控制器
CN105387858B (zh) 一种游艇智能导航系统及工作方法
CN206224239U (zh) 一种多传感器融合的拖拉机导航控制系统
CN109828587A (zh) 一种避障系统及避障方法
CN110530361A (zh) 一种基于农业机械双天线gnss自动导航系统的转向角度估计器
CN107505617A (zh) 一种雷达目标测试方法
CN109572857A (zh) 一种麦克纳姆轮智能仓储agv及其路径规划方法
Jun et al. Autonomous driving system design for formula student driverless racecar
CN109508006A (zh) 一种基于北斗的汽车起重机的自动驾驶系统
CN114322980A (zh) 获取位置坐标及绘制电子地图的方法、计算机可读存储介质和自主作业设备
CN115903800A (zh) 一种基于领导者协同的多无人船编队的严格安全控制方法
CN115373388A (zh) 一种舰载机器人的路径规划系统及方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20240102

Address after: 252513 South side of Provincial Road 329, Jia Town, Guan County, Liaocheng City, Shandong Province

Applicant after: SHANDONG SHUANGLI MODERN AGRICULTURAL EQUIPMENT CO.,LTD.

Address before: 252000 No. 1, Hunan Road, Shandong, Liaocheng

Applicant before: LIAOCHENG University

GR01 Patent grant
GR01 Patent grant