CN101866181A - 农用机械的导航方法、导航装置和农用机械 - Google Patents
农用机械的导航方法、导航装置和农用机械 Download PDFInfo
- Publication number
- CN101866181A CN101866181A CN200910082462A CN200910082462A CN101866181A CN 101866181 A CN101866181 A CN 101866181A CN 200910082462 A CN200910082462 A CN 200910082462A CN 200910082462 A CN200910082462 A CN 200910082462A CN 101866181 A CN101866181 A CN 101866181A
- Authority
- CN
- China
- Prior art keywords
- farm machinery
- information
- path
- agricultural machinery
- machinery
- 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
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Guiding Agricultural Machines (AREA)
Abstract
本发明提供了一种农用机械的导航方法、导航装置和农用机械,其中农用机械的导航方法包括:通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息;根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算以获取农用机械的预期路径信息;根据农用机械的两轮运动学模型以及跟踪问题终端时间无限调节器设计准则设计了路径跟踪最优控制器;根据所述农用机械的定位信息和所述预期路径信息获取路径误差;根据所述路径误差信息以及路径跟踪最优控制器获取路径调整信息并发送给自动转向***。本发明实施例还提供了农用机械的导航装置以及具有上述导航装置的农用机械。上述方法、装置和设备能够提高导航的精确度。
Description
技术领域
本发明涉及机械导航技术领域,特别涉及一种农用机械的导航方法、导航装置和农用机械。
背景技术
农用机械的导航可定义为根据农用机械的实际位置与期望路径的误差确定车辆转向角的大小,使其按照预定的路径行使。农用机械的导航***可以包括定位、路径规划、导航控制、机械模型和通信等模块。
其中的定位主要是根据相应的传感器检测农用机械的位置、姿态、速度、加速度等信息,具体可以使用机械视觉、激光定位、全球定位***(GlobalPositioning System,以下简称:GPS)、惯性导航定位或电子罗盘定位的方法。同时也可以采用多种定位方法的融合,充分利用多个传感器资源实现检测信息的合理支配和应用。路径规划是指确定农用机械的路径信息,包括路线的弯曲半径、长度等几何信息以及农用机械的航向角、前轮转向角、地面的倾斜度等信息。导航控制模块用于控制农用机械按照规划的路线行驶。机械模型是为研究对象建立的数学模型,能够进行***仿真。通信模块用于完成上述各个模块之间的数据交换。
发明人在实现本发明的过程中发现,现有的农用机械对导航***存在跟踪精度低的缺点,容易引起较大的跟踪误差,无法实现精确导航。
发明内容
本发明的目的是提供一种农用机械的导航方法、导航装置和农用机械,以实现对农用机械的精确导航。
为实现上述目的,本发明提供了一种农用机械的导航方法,包括:
通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息;
根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算以获取农用机械的预期路径信息;
根据农用机械的两轮运动学模型以及跟踪问题终端时间无限调节器设计准则生成路径跟踪最优控制器;
根据所述农用机械的定位信息和所述预期路径信息获取路径误差;
根据所述路径误差信息及路径跟踪最优控制器获取路径调整信息并发送给自动转向***。
本发明还提供了一种农用机械的导航装置,包括:
定位信息获取模块,用于通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息;
预期路径计算模块,用于根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算以获取农用机械的预期路径信息;
最优控制器生成模块,用于根据农用机械的两轮运动学模型以及跟踪问题终端时间无限调节器设计准则生成路径跟踪最优控制器;
路径误差获取模块,用于根据所述农用机械的定位信息和所述预期路径信息获取路径误差;
发送模块,用于根据所述路径误差信息及路径跟踪最优控制器获取调整信息并发送给自动转向***。
本发明还提供了一种农用机械,包括农用机械本体和人工转向***,还包括:
导航装置,用于通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息;根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算以获取农用机械的预期路径信息;根据农用机械的两轮运动学模型以及跟踪问题终端时间无限调节器设计准则生成路径跟踪最优控制器;根据所述农用机械的定位信息和所述预期路径信息获取路径误差;根据所述路径误差信息及路径跟踪最优控制器获取路径调整信息并发送给自动转向***;
自动转向***,与导航装置连接,用于根据导航装置的调整信息对农用机械进行控制。
本发明上述实施例提供的农用机械的导航方法、导航装置和农用机械,通过一个以上的传感器获取农用机械的定位信息,并根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题计算获取了农用机械的预期路径信息;根据上述信息可获取农用机械的路径误差,最后根据上述的路径误差通过路径跟踪最优控制器计算获取路径调整信息,并将其发送给农用机械上设置的自动转向***,可实现对农用机械的精确导航。
附图说明
图1为本发明农用机械的导航方法实施例的流程示意图;
图2为本发明农用机械的运动示意图;
图3为本发明农用机械的导航装置实施例的结构示意图;
图4为本发明农用机械的导航装置具体实施例的结构示意图;
图5为本发明农用机械实施例的结构示意图;
图6为本发明实施例中转向***具体实施例示意图。
具体实施方式
下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。
本发明实施例提供了一种农用机械的导航方法,图1为本发明农用机械的导航方法实施例的流程示意图,如图1所示,包括如下步骤:
步骤101、通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息;本步骤中一个或多个传感器获取农用机械的位姿信息,包括位置、航向、前轮转向角及速度等数据,上述的传感器可以包括全球定位***(Global Positioning System,以下简称:GPS)、惯性测量单元(Inertia Measurement Unit,以下简称:IMU)以及电子罗盘中的一个或多个,上述传感器通过标准串口与工控机连接,并将获取的数据存储到工控机中,然后进行信号转换和处理即可得到农用机械的位姿数据,例如包括数据由经纬度向大地坐标的转换,位姿数据的坐标统一化等处理;上述的位姿数据是相对独立的,需要进行数据融合以获得最终的定位信息,本步骤中可以根据基于双模糊控制器的自适应卡尔曼滤波算法对上述获取的位姿数据进行数据融合,并获取农用机械的位置坐标、速度和航向信息的定位信息。例如可以取***的状态向量为:X=[x,y,θ,α,v]T,其中x,y为融合后的位置坐标,θ为融合后的航向角,α为农用机械的前轮转向角,v为农用机械的行驶速度;观测向量为:Z=[xDR yDR xGPS yGPS θDR θc α]T,其中xDR,yDR和θDR分别为由IMU获取的信息经航位推算后得到的位置坐标和航向角,xGPS,yGPS为GPS获取的位置信息经坐标转换后的位置坐标,θc为电子罗盘获取的航向角;
步骤102、根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算以获取农用机械的预期路径信息;本步骤是根据两轮运动学模型建立农用机械的状态方程,并根据最优控制器中的最小时间问题获取农用机械的预期路径信息;
步骤103、根据农用机械的两轮运动学模型以及跟踪问题终端时间无限调节器设计准则进行路径跟踪最优控制器设计;
步骤104、根据所述农用机械的定位信息和所述预期路径信息获取路径误差;本步骤是在上述步骤101和步骤102的基础上,通过计算获取路径误差;
步骤105、根据所述路径误差信息以及步骤103设计的路径跟踪最优控制器获取调整信息并发送给自动转向***,本步骤是在获取到路径误差之后,即可计算得出相应路径调整信息并发送给自动转向***,由自动转向***控制农用机械进行路径调整。本步骤中的自动转向***可以是在原人工转向***的基础上并列设置,并且可以选择使用其中的自动转向***或者是人工转向***。
本发明上述实施例提供的农用机械的导航方法,能够根据获取的农用机械的定位信息、预期路径信息获取路径误差,且上述的预期路径信息为根据农用机械的两轮运动学模型以及最优控制理论的最小时间问题计算方法获取;并根据该路径误差及路径跟踪最优控制器获得路径调整信息,进而将其发送给自动转向***实现对农用机械的调整。
以下是本发明一个具体实施例,在GPS、IMU和电子罗盘获取到位置、航向角等数据信息后,利用自适应卡尔曼滤波器对上述的数据信息进行融合,首先建立状态方程模型,此时假设农用机械在平面上行驶并且不考虑车轮与地面的作用,认为左右部分对称无倾斜、俯仰、侧滑等运动,则农用机械的运动可以看作是一种平面的刚体的平动与旋转运动的二轮模型,如图2所述示,其中θ为航向角,α为前轮转向角,l为轴距,v为车速,沿x、y轴可以分解为vx和vy,vf为前轮速度。则其运动学模型为:
并取***的状态变量为:X=[x,y,θ,α,v]T,其中x,y为融合后的位置坐标,θ为融合后的航向角,α为农用机械的前轮转角的角度,v为农用机械的行驶速度。因此可得***的状态方程为:
其中,τα和τv为时间常数,wα和wv分别为农用机械前轮转角和速度的噪声。将状态方程离散化,得到***离散的状态方程为:
Xk=f[Xk-1,k-1]+Wk-1
上式中,k为离散时各向量的索引数,Wk-1=[0,0,0,wα,wv]T。
根据卡尔曼(Kalman)滤波原理可以得到:
Xk=Φk,k-1Xk-1+Wk-1
上式中:
其中,T为滤波器的递推时间间隔。
在上述步骤基础上,可以建立量测方程,取量测向量为:
Z=[xDR,yDR,xGPS,yGPS,θDR,θc,α]T
可建立量测方程:
Zk=HXk+Vk
上式中H为观测矩阵,可表示为:
其中,v为传感器的观测噪声,近似为(0,σ2)的高斯白噪声。
再次利用Kalman滤波算法进行处理,该算法可包括如下的流程:
状态一步预测方程:
一步预测误差方差阵:
滤波增益矩阵:
状态估计方程:
估计误差方差阵:
Pk=[I-KkHk]Pk,k-1
在上述对数据信息进行融合后,即可采用模糊逻辑控制器对卡尔曼滤波器的增益矩阵K、测量误差协方差R以及观测误差协方差Q进行实时修正,将卡尔曼滤波其调整到最优状态。通过两个模糊控制器分别确定滤波增益、滤波噪声的调整***μr和***噪声的调整系数μq,具体包括如下的步骤:
首先,建立滤波器增益Kk和测量噪声R(t)系数模糊控制器;
滤波器增益Kk和测量噪声R(t)都受到传感器信号质量的影响,它们同GPS、航位推算两种定位方式获得的位置差值Δy和GPS的位置精度因子间存在一定的模糊关系。该模糊控制器的输入为GPS、航位推算两种定位方式获得的位置差Δy和GPS的位置精度因子,输出为滤波增益、测量噪声的调整系数μr。
其次,建立基于新息向量Zk变化的Q(t)系数模糊控制器;
Q(t)是***的过程噪声的方程强度阵,受到***过程噪声的影响,该值不易直接测得,常通过对各预测信号的***噪声估计得到。然而这种估计是建立在新息是零均值白噪声的基础上的。由于新息是观测值与预测值的差,故当滤波器处于最优状态时,新息的值是一组零均值的白噪声。而在田间作业过程中,由于受到各种干扰的影响,新息的值会夹杂不同程度的有色噪声,新息的值越大,说明此时***的观测值和预测值差异越大,即***的过程噪声越大,导致Q(t)的值也越大,因此Q(t)的值与新息向量Zk的大小存在一定的模糊关系。建立基于新息变化的模糊控制器,对Q(t)的值进行实时在线调整,另卡尔曼滤波器始终处于最优状态。该模糊控制器的输入为横向偏差与航向角的新息值Z(x),Z(y)和Z(θ),输出为Q(x),Q(y)和Q(θ)。则过程噪声Q(t)的调整系数矩阵为μq为:
上述实施例中采用具有双模糊控制器的卡尔曼滤波算法对个传感器获取的数据进行了融合,获取了包括农用机械的位置坐标、速度和航向信息的定位信息。
对于农用机械的导航***来说,除了要获取上述的农用机械的位置信息,还需要获取农用机械理想的路径,即预期路径信息,本实施例中首先由农用机械的两轮运动学模型示意图获取农用机械的状态方程,即:
其中状态量为:X=[x,y,θ,α]T;u为要求解的控制量。
在本实施例中采用最优控制理论中的最小时间问题进行预期路径规划,其性能指标如下:
上式中:X0=[x0,y0,θ0,α0]T为农用机械要到达的目标点;αmax为转向***的最大转向角;r为惩罚因子;tf为终端时间。
根据目标点信息,解上述最小时间问题即可获取农用机械的预期路径信息,包括位置信息,航向信息和转向信息。
将拖拉机当前点Q的状态量和目标点P的状态量的差表示为:
对上述状态方程进行变分得到如下的状态方程:
在本实施例中采用最优控制理论中的终端无限时间调节器设计准则设计导航跟踪最优控制器,上述设计准则如下:
其中,矩阵Q为对角阵,R为常数,反映前轮转向角和拖拉机速度的权重。
可得出Riccati代数方程为:
PA+ATP-PBR-1BTP+Q=0
解上述矩阵方程即可求得路径跟踪最优控制器:
δu=Kuδx, Ku=-R-1BTP
图3为本发明农用机械的导航装置实施例的结构示意图,如图3所示,农用机械的导航装置包括:定位信息获取模块11、预期路径计算模块12、最优控制器生成模块13、路径误差获取模块14和发送模块15,其中定位信息获取模块11用于通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息;预期路径计算模块12用于根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算以获取农用机械的预期路径信息;最优控制器生成模块13用于根据农用机械的两轮运动学模型以及跟踪问题终端时间无限调节器设计准则生成路径跟踪最优控制器;路径误差获取模块14用于根据所述农用机械的定位信息和所述预期路径信息获取路径误差;发送模块15用于根据所述路径误差信息及路径跟踪最优控制器获取调整信息并发送给自动转向***。
本实施例提供的农用机械的导航装置,通过农用机械的定位信息和预期路径信息获取路径误差,并根据路径误差信息及路径跟踪最优控制器获取路径调整信息并发送给自动转向***。其中预期路径信息为预期路径计算模块根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算获得;路径跟踪最优控制器根据最优控制理论中的终端无限时间调节器设计准则进行设计获得。
上述实施例中的定位信息获取模块包括一个以上的传感器及计算单元,所述传感器用于获取农用机械的位姿数据;所述计算单元用于根据基于双模糊控制器的自适应卡尔曼滤波算法对上述获取的位姿数据进行数据融合以获取包括农用机械的位置坐标、速度和航向信息的定位信息。
图4为本发明农用机械的导航装置具体实施例的结构示意图,如图4所示,其中GPS、IMU以及电子罗盘获取农用机械的位姿数据,经过计算单元进行上述数据信息的融合处理获取农用机械的定位信息,并且预期路径获取模块进行计算获取预期的路径信息,通过对上述的信息进行分析,经过路径跟块进行计算获取预期的路径信息,通过对上述的信息进行分析,经过路径跟踪最优控制器可以获取对农用机械的调整信息,可将该调整信息发送给自动转向***实现调整,角位移传感器能够将机械装置的角度变化为电压信号。
图5为本发明农用机械实施例的结构示意图,如图5所示,包括农用机械本体21、人工转向***22、导航装置23和自动转向***24,其中导航装置23用于通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息;根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算以获取农用机械的预期路径信息;根据农用机械的两轮运动学模型以及跟踪问题终端时间无限调节器设计准则生成路径跟踪最优控制器;根据所述农用机械的定位信息和所述预期路径信息获取路径误差;根据所述路径误差信息获取调整信息并发送给自动转向***;自动转向***24与导航装置23连接,用于根据导航装置的调整信息对农用机械进行控制。
本实施例提供的农用机械,其中的导航装置根据获取的农用机械的定位信息以及计算获取的农用机械的预期路径信息获取路径误差,并根据路径误差获取调整信息,由自动转向***对农用机械进行控制,能够实现对农用机械的精确导航。
上述的自动转向***包括油泵、电磁换向阀、驱动模块和步进电机,其中用于为自动转向***提供转向动力;电磁换向阀用于进行人工转向***和自动转向***的切换,选择自动控制***作为农用机械的控制***;驱动模块用于根据接收到的调整信息生成控制信号;步进电机与所述驱动模块连接,用于根据控制信号调整液压转向器转向和转向速度。
图6为本发明实施例中转向***具体实施例示意图,其中包括并列设置的自动转向***1与人工转向***2,从而可以选择使用其中的一个转向***进行转向。具体的在实施过程中,可以由电磁换向阀3根据控制器的指令进行人工装箱模式或自动换向模式的切换,具体的可以是一个二位三通电磁换向阀实现,该二位三通电磁换向阀与油泵4配合使用,油泵4是转向***的动力源,为转向控制***供给具有压力的液压油,油泵的技术参数可以设置为:额定压力10Mpa,排量14ml/r,最大工作压力12.5Mpa,安全阀调整范围5~12.5Mpa,额定转速2000r/min,转速范围800~3000r/min,输出流量为12、14或16L/min;油泵的主要技术参数可以设为:工作电压12V,功率30W,最高压力35Mpa,流量50L/min;在具体实施过程中,可以在电磁换向阀断电时,阀芯在弹簧力的作用下处于右位,油泵的液压油流向原人工转向器,此时人工转向***起作用;当加装的转向器处于中位时,它与油源的连接电磁换向阀断开,与转向油缸的连接被自身特定结构断开,处于隔离状态,不起转向作用。当上述的电磁换向阀通电时,电磁换向阀的阀芯处于左位,液压油流向加装的自动转向***,此时由步进电机驱动自动转向***实现自动转向功能,同理,原转向器处于隔离状态,不起转向作用。调整步进电机的转速实现转向轮转向速度控制,控制步进电机的转向实现转向轮的转向控制。
自动转向***的液压转向器5由步进电机6驱动,根据步进电机的转向、转角大小,定向、定量的将液压油输入转向油缸7左腔或右腔,推动导向轮驶向动力转向,另一腔的油则经过转向器回油箱8。自动转向***可选用与人工转向***相同的液压转向器9,以便于***匹配,即能够满足原液压转向***压力、流量和温度等性能的要求,例如可选用具有如下技术参数的液压转向器:转动扭矩4.0~5.0N·m,流量7.51/min,排量100ml/r,额定工作压力16Mpa,最大瞬时背压6.3Mpa,最大连续背压2.5Mpa,***工作温度-20~80℃。
全液压转向器地转向扭矩的大小直接决定了所需步进电机地功率,如果液压转向器的扭矩过大,受车载电源电压的限制能够满足功率要求的步进电机很难选择,全液压转向器的额定转速n可以如下的公式计算获得:其中q为液压转向器的流量,V为液压转向器的排量,根据上述参数的液压转向器,则液压转向器的额定转速在液压转向器以额定转速转动时步进电机的功率P由如下公式计算:
其中液压转向器的额定转速n为75rpm,转动扭矩M为5N·m,步进电机的效率ηs为75%,机械传动效率ηm为80%,因步进电机过载能力差,选择功率余量为50%。步进电机的工作电压选择12伏的直流电压,功率为99W时,步进电机的工作电流I为:
在上述实施例中,步进电机的电流需要达到8.25A。本发明实施例中还可以进一步减少转向器中复位弹簧片的数量,将其复位弹簧片减至两片,将液压转向器的转动扭矩降到0.8N·m以下,能够降低了转向所需要的扭矩。改装后步进电机的功率为:
计算可得其电流I为1.4A,从而能够更好的选择合适的步进电机,具体的可选择具有如下技术参数的步进电机:步距角1.8°,相数4,电压4.4V,电流2A,最大静转矩2.1N·m,转动惯量2Kg·cm2,阻抗2.2±10ohm,重量2.2Kg。
角位移传感器能够将机械装置的角度变化为电压信号,在本***中利用角位移转向器测量转向轮的转向角度,并且角位置传感器的精度直接决定着控制***的转向精度,是农用机械自动驾驶控制***控制精度的基础,需要选择具有较高精度的角位移传感器,具体的可以参考选择具有如下技术参数的角位移传感器:电压12VDC,机械转角360连续可转,线性量程0~120,输出信号0~5V,分辨率为连续,精度0.1,相对湿度95±3%RH,使用温度-30~80℃,抗电等级500V,防护等级IP64。
本发明上述实施例提供的农用机械的导航方法、导航装置和农业机械,能够通过获取农用机械的定位信息和预期路径,并根据上述定位信息和预期路径信息计算得出调整信息,对农用机械的运行进行导航,并能够提高导航的精确度。
最后应说明的是:以上实施例仅用以说明本发明的技术方案而非对其进行限制,尽管参照较佳实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对本发明的技术方案进行修改或者等同替换,而这些修改或者等同替换亦不能使修改后的技术方案脱离本发明技术方案的精神和范围。
Claims (9)
1.一种农用机械的导航方法,其特征在于,包括:
通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息;
根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算以获取农用机械的预期路径信息;
根据农用机械的两轮运动学模型以及跟踪问题终端时间无限调节器设计准则生成路径跟踪最优控制器;
根据所述农用机械的定位信息和所述预期路径信息获取路径误差;
根据所述路径误差信息及路径跟踪最优控制器获取路径调整信息并发送给自动转向***。
2.根据权利要求1所述的农用机械的导航方法,其特征在于,所述通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息包括:
从一个以上的传感器中获取农用机械的位姿数据;
根据基于双模糊控制器的自适应卡尔曼滤波算法对上述获取的位姿数据进行数据融合以获取包括农用机械的位置坐标、速度和航向信息的定位信息。
3.根据权利要求1所述的农用机械的导航方法,其特征在于,所述最优控制器随机械在路径中位置的变化而变化。
4.根据权利要求1所述的农用机械的导航方法,其特征在于,还包括:
自动转向***的驱动模块根据调整信息生成调整信号,并将所述调整信号发送给液压转向器,由所述液压转向器驱动转向轮进行转向。
5.一种农用机械的导航装置,其特征在于,包括:
定位信息获取模块,用于通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息;
预期路径计算模块,用于根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算以获取农用机械的预期路径信息;
最优控制器生成模块,用于根据农用机械的两轮运动学模型以及跟踪问题终端时间无限调节器设计准则生成路径跟踪最优控制器;
路径误差获取模块,用于根据所述农用机械的定位信息和所述预期路径信息获取路径误差;
发送模块,用于根据所述路径误差信息及所述路径跟踪最优控制器获取调整信息并发送给自动转向***。
6.根据权利要求5所述的农用机械的导航装置,其特征在于,所述定位信息获取模块包括一个以上的传感器及计算单元,所述传感器用于获取农用机械的位姿数据;所述计算单元用于根据基于双模糊控制器的自适应卡尔曼滤波算法对上述获取的位姿数据进行数据融合以获取包括农用机械的位置坐标、速度和航向信息的定位信息。
7.一种农用机械,包括农用机械本体和人工转向***,其特征在于,还包括:
导航装置,用于通过一个以上的传感器获取包括农用机械的位置坐标、速度和航向信息的定位信息;根据农用机械的两轮运动学模型以及最优控制理论中的最小时间问题进行计算以获取农用机械的预期路径信息;根据农用机械的两轮运动学模型以及跟踪问题终端时间无限调节器设计准则生成路径跟踪最优控制器;根据所述农用机械的定位信息和所述预期路径信息获取路径误差;根据所述路径误差信息及路径跟踪最优控制器获取路径调整信息并发送给自动转向***;
自动转向***,与导航装置连接,用于根据导航装置的调整信息对农用机械进行控制。
8.根据权利要求7所述的农用机械,其特征在于,所述自动转向***包括:
油泵,用于为自动转向***提供转向动力;
电磁换向阀,用于进行人工转向***和自动转向***的切换,选择自动控制***作为农用机械的控制***;
驱动模块,用于根据接收到的导航装置发送的调整信息生成控制信号;
步进电机,与所述驱动模块连接,用于根据控制信号调整液压转向器转向和转向速度,控制转向轮进行转向。
9.根据权利要求8所述的农用机械,其特征在于,还包括:
角位移传感器,用于测量转向轮的转向角度,并将测量结果发送给导航装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2009100824621A CN101866181B (zh) | 2009-04-16 | 2009-04-16 | 农用机械的导航方法、导航装置和农用机械 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2009100824621A CN101866181B (zh) | 2009-04-16 | 2009-04-16 | 农用机械的导航方法、导航装置和农用机械 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101866181A true CN101866181A (zh) | 2010-10-20 |
CN101866181B CN101866181B (zh) | 2011-12-14 |
Family
ID=42957938
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2009100824621A Expired - Fee Related CN101866181B (zh) | 2009-04-16 | 2009-04-16 | 农用机械的导航方法、导航装置和农用机械 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101866181B (zh) |
Cited By (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506852A (zh) * | 2011-11-01 | 2012-06-20 | 丁幼春 | 农用车辆视觉导航***及其导航方法 |
CN102591332A (zh) * | 2011-01-13 | 2012-07-18 | 同济大学 | 用于无人驾驶汽车局部路径规划的装置及方法 |
CN103196441A (zh) * | 2013-03-19 | 2013-07-10 | 江苏大学 | 一种喷雾机械组合导航方法及*** |
CN103247213A (zh) * | 2013-03-13 | 2013-08-14 | 北京农业智能装备技术研究中心 | 拖拉机自动导航实验台 |
CN103499973A (zh) * | 2013-09-30 | 2014-01-08 | 中国农业大学 | 一种主-从机协同作业农业机械智能导航*** |
CN103914066A (zh) * | 2012-12-28 | 2014-07-09 | 中国科学院沈阳自动化研究所 | 农机自动导航控制器及其控制方法 |
CN104216405A (zh) * | 2013-06-04 | 2014-12-17 | 内蒙古大学 | 田间机器人的导航方法及设备 |
CN104295551A (zh) * | 2014-08-18 | 2015-01-21 | 中国农业大学 | 一种自动转向比例控制阀块及基于该阀块的导航液压*** |
CN104571109A (zh) * | 2015-01-04 | 2015-04-29 | 南京农业大学 | 一种基于扰动观测器的农用车辆自主导航转向控制方法 |
CN104991559A (zh) * | 2015-07-08 | 2015-10-21 | 江苏大学 | 一种自动巡航检测温室综合信息的方法 |
CN105022399A (zh) * | 2015-07-16 | 2015-11-04 | 柳州六品科技有限公司 | 对于作业机构具有改进的地面跟随农机控制*** |
CN106647770A (zh) * | 2017-01-22 | 2017-05-10 | 无锡卡尔曼导航技术有限公司 | 用于农机无人驾驶的田间掉头路径规划及其控制方法 |
CN107015477A (zh) * | 2017-04-05 | 2017-08-04 | 同济大学 | 基于状态反馈的车辆路径跟踪h∞控制方法 |
CN107703945A (zh) * | 2017-10-30 | 2018-02-16 | 洛阳中科龙网创新科技有限公司 | 一种多目标融合的智能农用机械路径规划方法 |
CN107807644A (zh) * | 2017-10-30 | 2018-03-16 | 洛阳中科龙网创新科技有限公司 | 一种农用机械最低油耗运动路径规划方法 |
CN107861503A (zh) * | 2016-09-21 | 2018-03-30 | 艾格赛尔工业公司 | 车辆控制装置,相应车辆以及方法 |
CN108260401A (zh) * | 2017-01-04 | 2018-07-10 | 西北农林科技大学 | 一种基于ros无人驾驶联合收割机激光导航*** |
CN108427416A (zh) * | 2018-04-04 | 2018-08-21 | 上海华测导航技术股份有限公司 | 一种无人船差速自动转向控制***及控制方法 |
CN108438048A (zh) * | 2018-04-04 | 2018-08-24 | 上海华测导航技术股份有限公司 | 一种新型的履带式拖拉机自动转向控制***及控制方法 |
CN108496533A (zh) * | 2017-02-27 | 2018-09-07 | 西北农林科技大学 | 一种无人驾驶联合收割机激光导航*** |
CN108508899A (zh) * | 2018-05-07 | 2018-09-07 | 湖北汽车工业学院 | 一种无人驾驶车辆轨迹跟踪控制行驶*** |
CN108614567A (zh) * | 2018-06-20 | 2018-10-02 | 安徽酷哇机器人有限公司 | 智能环卫作业车控制*** |
CN108646747A (zh) * | 2018-06-05 | 2018-10-12 | 上海交通大学 | 农用车辆路径跟踪控制方法 |
CN109005864A (zh) * | 2017-06-09 | 2018-12-18 | 安德烈·斯蒂尔股份两合公司 | 确定特定控制参数范围的方法和相关方法、***、机器人 |
CN109115225A (zh) * | 2018-08-31 | 2019-01-01 | 江苏大学 | 一种无人作业谷物联合收割机导航方法与导航装置 |
CN109508007A (zh) * | 2018-12-11 | 2019-03-22 | 东南大学 | 一种基于多源信息融合的农机轨迹跟踪、避障***及方法 |
CN109656240A (zh) * | 2017-10-10 | 2019-04-19 | 雷沃重工股份有限公司 | 一种车辆路径跟踪控制装置、方法和车辆 |
CN109726480A (zh) * | 2018-12-29 | 2019-05-07 | 青岛慧拓智能机器有限公司 | 一种用于验证无人矿卡相关算法的*** |
CN109885063A (zh) * | 2019-03-15 | 2019-06-14 | 江苏大学 | 一种融合视觉和激光传感器的施药机器人农田路径规划方法 |
WO2019228435A1 (zh) * | 2018-06-01 | 2019-12-05 | 浙江亚特电器有限公司 | 用于移动载具的路径跟踪方法 |
CN113419523A (zh) * | 2021-06-08 | 2021-09-21 | 无锡卡尔曼导航技术有限公司 | 一种适用于无角度传感器的农机获得前轮期望角度的方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3485239B2 (ja) * | 1997-09-10 | 2004-01-13 | 富士重工業株式会社 | 車両運動制御装置 |
JP2000029521A (ja) * | 1998-07-08 | 2000-01-28 | Fuji Heavy Ind Ltd | 自律走行方法及び自律走行車 |
CN101082493B (zh) * | 2007-06-28 | 2011-01-19 | 华南农业大学 | 一种农业机械导航的组合定位方法 |
CN101221447A (zh) * | 2008-01-18 | 2008-07-16 | 中国农业大学 | 一种机械自动转向控制方法 |
-
2009
- 2009-04-16 CN CN2009100824621A patent/CN101866181B/zh not_active Expired - Fee Related
Cited By (38)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102591332A (zh) * | 2011-01-13 | 2012-07-18 | 同济大学 | 用于无人驾驶汽车局部路径规划的装置及方法 |
CN102591332B (zh) * | 2011-01-13 | 2014-08-13 | 同济大学 | 用于无人驾驶汽车局部路径规划的装置及方法 |
CN102506852B (zh) * | 2011-11-01 | 2016-08-03 | 华中农业大学 | 农用车辆视觉导航***及其导航方法 |
CN102506852A (zh) * | 2011-11-01 | 2012-06-20 | 丁幼春 | 农用车辆视觉导航***及其导航方法 |
CN103914066A (zh) * | 2012-12-28 | 2014-07-09 | 中国科学院沈阳自动化研究所 | 农机自动导航控制器及其控制方法 |
CN103247213A (zh) * | 2013-03-13 | 2013-08-14 | 北京农业智能装备技术研究中心 | 拖拉机自动导航实验台 |
CN103196441A (zh) * | 2013-03-19 | 2013-07-10 | 江苏大学 | 一种喷雾机械组合导航方法及*** |
CN104216405A (zh) * | 2013-06-04 | 2014-12-17 | 内蒙古大学 | 田间机器人的导航方法及设备 |
CN103499973A (zh) * | 2013-09-30 | 2014-01-08 | 中国农业大学 | 一种主-从机协同作业农业机械智能导航*** |
CN103499973B (zh) * | 2013-09-30 | 2016-04-20 | 中国农业大学 | 一种主-从机协同作业农业机械智能导航*** |
CN104295551A (zh) * | 2014-08-18 | 2015-01-21 | 中国农业大学 | 一种自动转向比例控制阀块及基于该阀块的导航液压*** |
CN104295551B (zh) * | 2014-08-18 | 2016-03-23 | 中国农业大学 | 一种自动转向比例控制阀块及基于该阀块的导航液压*** |
CN104571109A (zh) * | 2015-01-04 | 2015-04-29 | 南京农业大学 | 一种基于扰动观测器的农用车辆自主导航转向控制方法 |
CN104991559A (zh) * | 2015-07-08 | 2015-10-21 | 江苏大学 | 一种自动巡航检测温室综合信息的方法 |
CN105022399A (zh) * | 2015-07-16 | 2015-11-04 | 柳州六品科技有限公司 | 对于作业机构具有改进的地面跟随农机控制*** |
CN107861503A (zh) * | 2016-09-21 | 2018-03-30 | 艾格赛尔工业公司 | 车辆控制装置,相应车辆以及方法 |
CN108260401A (zh) * | 2017-01-04 | 2018-07-10 | 西北农林科技大学 | 一种基于ros无人驾驶联合收割机激光导航*** |
CN106647770A (zh) * | 2017-01-22 | 2017-05-10 | 无锡卡尔曼导航技术有限公司 | 用于农机无人驾驶的田间掉头路径规划及其控制方法 |
CN108496533A (zh) * | 2017-02-27 | 2018-09-07 | 西北农林科技大学 | 一种无人驾驶联合收割机激光导航*** |
CN107015477A (zh) * | 2017-04-05 | 2017-08-04 | 同济大学 | 基于状态反馈的车辆路径跟踪h∞控制方法 |
CN109005864A (zh) * | 2017-06-09 | 2018-12-18 | 安德烈·斯蒂尔股份两合公司 | 确定特定控制参数范围的方法和相关方法、***、机器人 |
CN109656240A (zh) * | 2017-10-10 | 2019-04-19 | 雷沃重工股份有限公司 | 一种车辆路径跟踪控制装置、方法和车辆 |
CN107807644A (zh) * | 2017-10-30 | 2018-03-16 | 洛阳中科龙网创新科技有限公司 | 一种农用机械最低油耗运动路径规划方法 |
CN107703945A (zh) * | 2017-10-30 | 2018-02-16 | 洛阳中科龙网创新科技有限公司 | 一种多目标融合的智能农用机械路径规划方法 |
CN108438048A (zh) * | 2018-04-04 | 2018-08-24 | 上海华测导航技术股份有限公司 | 一种新型的履带式拖拉机自动转向控制***及控制方法 |
CN108427416A (zh) * | 2018-04-04 | 2018-08-21 | 上海华测导航技术股份有限公司 | 一种无人船差速自动转向控制***及控制方法 |
CN108427416B (zh) * | 2018-04-04 | 2021-09-07 | 上海华测导航技术股份有限公司 | 一种无人船差速自动转向控制***及控制方法 |
CN108438048B (zh) * | 2018-04-04 | 2021-05-14 | 上海华测导航技术股份有限公司 | 一种新型的履带式拖拉机自动转向控制***及控制方法 |
CN108508899A (zh) * | 2018-05-07 | 2018-09-07 | 湖北汽车工业学院 | 一种无人驾驶车辆轨迹跟踪控制行驶*** |
WO2019228435A1 (zh) * | 2018-06-01 | 2019-12-05 | 浙江亚特电器有限公司 | 用于移动载具的路径跟踪方法 |
US11334083B2 (en) | 2018-06-01 | 2022-05-17 | Zhejiang Yat Electrical Appliance Co., Ltd | Route tracking method for mobile vehicle |
CN108646747A (zh) * | 2018-06-05 | 2018-10-12 | 上海交通大学 | 农用车辆路径跟踪控制方法 |
CN108614567A (zh) * | 2018-06-20 | 2018-10-02 | 安徽酷哇机器人有限公司 | 智能环卫作业车控制*** |
CN109115225A (zh) * | 2018-08-31 | 2019-01-01 | 江苏大学 | 一种无人作业谷物联合收割机导航方法与导航装置 |
CN109508007A (zh) * | 2018-12-11 | 2019-03-22 | 东南大学 | 一种基于多源信息融合的农机轨迹跟踪、避障***及方法 |
CN109726480A (zh) * | 2018-12-29 | 2019-05-07 | 青岛慧拓智能机器有限公司 | 一种用于验证无人矿卡相关算法的*** |
CN109885063A (zh) * | 2019-03-15 | 2019-06-14 | 江苏大学 | 一种融合视觉和激光传感器的施药机器人农田路径规划方法 |
CN113419523A (zh) * | 2021-06-08 | 2021-09-21 | 无锡卡尔曼导航技术有限公司 | 一种适用于无角度传感器的农机获得前轮期望角度的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN101866181B (zh) | 2011-12-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101866181A (zh) | 农用机械的导航方法、导航装置和农用机械 | |
CN106476883B (zh) | 车辆的行驶控制装置 | |
US10795369B2 (en) | System and method for controlling a vehicle | |
Zhang et al. | A dynamic path search algorithm for tractor automatic navigation | |
Wang et al. | The improved pure pursuit algorithm for autonomous driving advanced system | |
CN104571112B (zh) | 基于转弯曲率估计的无人车横向控制方法 | |
CN101846734B (zh) | 农用机械导航定位方法、***及农用机械工控机 | |
CN105867377A (zh) | 一种农业机械自动导航控制方法 | |
Zhang et al. | Agricultural vehicle navigation using multiple guidance sensors | |
CN110502009A (zh) | 基于航向预估的无人驾驶车辆路径跟踪控制方法 | |
WO2016172729A1 (en) | System, apparatus, and method for controlling a vehicle | |
CN106502252A (zh) | 多传感器融合的拖拉机导航控制***及其定位、控制方法 | |
JP7072496B2 (ja) | 自動走行作業車のための制御装置 | |
CN109814550B (zh) | 一种用于封闭园区的无人运输车 | |
JP6216545B2 (ja) | 自律走行車両、車両の自律走行システム及び自律走行車両の制御方法 | |
CN109572857B (zh) | 一种麦克纳姆轮智能仓储agv及其路径规划方法 | |
Nguyen et al. | Lateral stability control of electric vehicle based on disturbance accommodating kalman filter using the integration of single antenna GPS receiver and yaw rate sensor | |
CN112596521A (zh) | 一种双舵轮磁导航agv纠偏方法及装置 | |
Lenain et al. | A new nonlinear control for vehicle in sliding conditions: Application to automatic guidance of farm vehicles using RTK GPS | |
JP6928571B2 (ja) | 自律走行システム | |
JP6871831B2 (ja) | 作業車両用の自律走行システム | |
JP6487264B2 (ja) | ウェイポイント生成装置 | |
CN114291117B (zh) | 一种四轮转向无人车辆轨迹跟踪控制方法 | |
Park et al. | When path tracking using look-ahead distance about the lateral error method and the velocity change method tracking comparison | |
Takigawa et al. | Trajectory control and its application to approach a target: Part I. Development of trajectory control algorithms for an autonomous vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20111214 Termination date: 20130416 |