CN114047748A - 用于农机自动驾驶的自适应前馈模型预测控制方法及系统 - Google Patents
用于农机自动驾驶的自适应前馈模型预测控制方法及系统 Download PDFInfo
- Publication number
- CN114047748A CN114047748A CN202111214177.8A CN202111214177A CN114047748A CN 114047748 A CN114047748 A CN 114047748A CN 202111214177 A CN202111214177 A CN 202111214177A CN 114047748 A CN114047748 A CN 114047748A
- Authority
- CN
- China
- Prior art keywords
- front wheel
- angle
- agricultural machinery
- delta
- adaptive feedforward
- 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
- 238000000034 method Methods 0.000 title claims abstract description 32
- 230000003044 adaptive effect Effects 0.000 title claims description 24
- 230000007246 mechanism Effects 0.000 claims abstract description 4
- 230000008569 process Effects 0.000 claims description 5
- 238000004088 simulation Methods 0.000 description 9
- 238000012546 transfer Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 4
- 239000011159 matrix material Substances 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000012360 testing method Methods 0.000 description 3
- 150000001875 compounds Chemical class 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000000611 regression analysis Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明提供一种用于农机自动驾驶的自适应前馈模型预测控制方法及系统,导航定位模块将获取的农机行驶状态信息传给行车控制模块,得到最终前轮转角,行车控制模块包括模型预测控制器和自适应前馈控制器,自适应前馈控制器根据横向误差和车速确定前馈补偿角,模型预测控制器基于车辆运动学模型,根据当前位置、航向角、参考位置、参考航向角、参考前轮转角、车速v和系统约束,求解前轮转角;安装在农机前轮的转角传感器实时向转向执行机构反馈实际前轮转角,当实际前轮转角等于最终前轮转角时,转向结束,实现农机的路径跟踪控制。本发明通过自适应前馈控制器补偿控制量,保证路径跟踪精度的同时提高了路径跟踪的效率。
Description
技术领域
本发明属于农用车辆自动驾驶技术领域,具体涉及一种用于农机自动驾驶的自适应前馈模型预测控制方法及系统。
背景技术
农用车辆无人化自动驾驶是智能农业研究的重点,而路径跟踪控制又是无人驾驶的核心技术。路径跟踪的目标是通过消除农机在行驶过程中实际行驶路径与规划路径之间的偏差,实现路径的准确跟踪。模型预测控制能够基于当前的状态量预测未来时刻的控制量,并且充分考虑状态量和控制量的约束条件,所以在路径跟踪控制领域得到应用。
中国专利(CN109884900A)公开了一种基于自适应模型预测控制的收获机路径跟踪控制方法,该方法根据跟踪路径和收获机的行驶速度自适应调整预测时间,实现自适应模型预测控制;该发明通过优选预测时域有效地解决了由于联合收获机质量大、惯性大造成的控制滞后问题,提高了路径跟踪效果;但该方法针对农机作业常出现的大角度转弯或180°调头等工况考虑不足,常出现路径跟踪误差较大的情况,同时该方法未考虑到横向误差较大时模型预测控制器的响应速度问题。
发明内容
针对现有技术中存在不足,本发明提供了一种用于农机自动驾驶的自适应前馈模型预测控制方法及系统,在农机横向误差较大时,通过自适应前馈控制器补偿控制量,提高系统响应速度,在农机横向误差较小时,通过模型预测控制器保证跟踪精度。
本发明是通过以下技术手段实现上述技术目的的。
一种用于农机自动驾驶的自适应前馈模型预测控制方法,具体为:
所述横向误差ΔX和车速v传输给自适应前馈控制器,确定前馈补偿角δq;所述当前位置(x,y)、航向角车速v及参考位置(xr,yr)、参考航向角参考前轮转角δfr传输给模型预测控制器,求解得到前轮转角δm;
根据前馈补偿角δq与前轮转角δm得到最终前轮转角δfinal,其中δfinal=min(δq+δm,δmax),δmax为农机前轮最大转角。
进一步地,所述前馈补偿角δq是根据以下规则确定的:
其中:K为斜率,且K=7.1396v-1.006。
进一步地,还包括:当转角传感器实时反馈的实际前轮转角,等于最终前轮转角δfinal时,转向结束,实现农机的路径跟踪控制。
一种用于农机自动驾驶的自适应前馈模型预测控制系统,包括:
导航定位模块,获取农机行驶状态信息;
行车控制模块,根据农机行驶状态信息得到最终前轮转角δfinal;
转角传感器,实时反馈实际前轮转角;
所述最终前轮转角δfinal和实际前轮转角均传输给转向执行机构,用于控制农机转向。
上述技术方案中,所述行车控制模块包括模型预测控制器和自适应前馈控制器,所述自适应前馈控制器用于确定前馈补偿角δq,所述模型预测控制器用于求解前轮转角δm。
本发明的有益效果为:
(1)本发明针对农机作业常出现路径跟踪误差较大的情况,设置不同情况下的前馈补偿角,具体为:当横向误差ΔX小于等于前馈补偿横向误差下限0.1m时,前馈补偿角为0;当横向误差ΔX大于前馈补偿横向误差下限0.1m且小于等于前馈补偿横向误差上限2m时,前馈补偿角为K(ΔX-0.1);当横向误差ΔX大于前馈补偿横向误差上限2m时,前馈补偿角为1.9K;本发明可以通过自适应前馈控制器补偿控制量,提高系统响应速度,在横向误差减小后通过模型预测控制器保证跟踪精度,在保证路径跟踪精度的同时提高了路径跟踪的效率。
(2)本发明将最终前轮转角设置为δfinal=min(δq+δm,δmax),保证前轮转角不会超过机械结构极限,防止转向机构损坏。
附图说明
图1为本发明所述用于农机自动驾驶的自适应前馈模型预测控制系统结构示意图;
图2为本发明所述用于农机自动驾驶的自适应前馈模型预测控制方法流程图;
图3为本发明所述农机路径跟踪示意图;
图4为本发明所述车辆运动学模型图;
图5为本发明所述不同车速v下前馈补偿角δq与横向误差ΔX的关系图;
图6为直线换道路径下本发明控制方法与普通模型预测控制方法仿真结果对比图;
图7为圆周路径下本发明控制方法与普通模型预测控制方法仿真结果对比图。
具体实施方式
下面结合附图以及具体实施例对本发明作进一步的说明,但本发明的保护范围并不限于此。
如图1所示,一种用于农机自动驾驶的自适应前馈模型预测控制系统,包括导航定位模块、行车控制模块、转向执行机构和转角传感器;导航定位模块安装在农机机身上,导航定位模块将获取的农机行驶状态信息传递给行车控制模块,行车控制模块得到最终前轮转角δfinal,并传递给转向执行机构控制农机转向,安装在农机前轮的转角传感器实时反馈实际前轮转角,当实际前轮转角等于最终前轮转角δfinal时,转向结束,从而实现农机的路径跟踪控制;行车控制模块包括模型预测控制器和自适应前馈控制器,自适应前馈控制器根据横向误差ΔX和车速v确定前馈补偿角δq,模型预测控制器基于车辆运动学模型,根据当前位置(x,y)、航向角参考位置(xr,yr)、参考航向角参考前轮转角δfr、车速v和系统约束求解前轮转角δm。
如图2所示,一种用于农机自动驾驶的自适应前馈模型预测控制方法,具体包括如下步骤:
步骤(1),导航定位模块实时获取农机行驶状态信息,包括当前位置(x,y)、航向角和车速v;如图3所示,以田块的长边为X轴,以田块的宽边为Y轴,以长宽交点为坐标原点,建立田块坐标系XOY;曲线D为已规划路径的一部分,它是由多个参考路径点连接而成;定义农机质心位置为农机当前位置(x,y),农机车身与X轴的夹角为航向角已规划路径上离农机当前位置(x,y)最近的参考路径点为参考位置(xr,yr),行驶过程中的横向误差ΔX是农机当前位置(x,y)到已规划路径的最短距离;对应参考路径点的航向角为参考航向角对应参考路径点的前轮转角为参考前轮转角δfr,且:
导航定位模块将获取的农机行驶状态信息传递给行车控制模块,其中横向误差ΔX和车速v传递给预置于行车控制模块中的自适应前馈控制器,当前位置(x,y)、航向角参考位置(xr,yr)、参考航向角参考前轮转角δfr和车速v传递给模型预测控制器。
步骤(2),自适应前馈控制器根据横向误差ΔX和车速v,确定前馈补偿角δq;
当横向误差ΔX小于等于前馈补偿横向误差下限0.1m时,前馈补偿角δq为0;当横向误差ΔX大于前馈补偿横向误差下限0.1m且小于等于前馈补偿横向误差上限2m时,前馈补偿角δq为K(ΔX-0.1),其中K为斜率,且K=7.1396v-1.006(斜率K的获取方法为:基于粒子群算法pso,通过控制路径跟踪收敛后的横向误差和前轮转角增量,得到不同车速v下的最优解K。对不同车速v下的最优K进行曲线拟合和回归分析,得到车速v与K的近似关系K=7.1396v-1.006),车速v的单位为m/s;当横向误差ΔX大于前馈补偿横向误差上限2m时,前馈补偿角δq为δqmax=1.9K;上述前馈补偿角δq的确定规则具体表示为:
模型预测控制器求解前轮转角δm的具体方法为:
如图4所示,在田块坐标系下,建立车辆运动学方程:
对于给定的参考路径,可以由农机的运动轨迹描述,运动轨迹上的每一个点都满足车辆运动学方程,用r代表参考量,车辆运动学方程的一般形式为:
设定农机行驶速度v与参考车速vr保持一致且恒定,将车辆运动学方程在参考点(xr,yr)处进行泰勒展开并忽略高阶项,可得:
将上式与参考点处的车辆运动学方程相减,可得:
并对其进行离散化处理,可得到最终的车辆运动学模型为:
设定模型预测控制器的预测时域为Np、控制时域为Nc,模型预测控制器t时刻的输出为:
Y(t)=Ψtζ(k|t)+ΘtΔU(t)
将控制增量作为模型预测控制器目标函数的状态量,并且引入松弛因子,避免出现无可行解的情况,模型预测控制器的目标函数为:
式中,ηref为参考的输出量,Q、F和ρ为权重矩阵,ε为松弛因子。
路径跟踪过程中,需要对控制量和控制增量加以约束,模型预测控制器的约束如下:
Δumin(t+j)≤Δu(t+j)≤Δumax(t+j),j=0,1...,Nc-1
将求解带约束的目标函数J(k)转化为求解带约束的线性二次型规划问题,得到控制时域内时刻t的最优控制增量序列ΔU(t),将序列的第一个元素Δu(k|t)作用于模型预测控制器,模型预测控制器求解出前轮转角
步骤(4),行车控制模块根据前馈补偿角δq与前轮转角δm得到最终前轮转角δfinal,并传递给转向执行机构控制农机转向,转角传感器实时反馈实际前轮转角,实际前轮转角等于最终前轮转角δfinal时转向结束,实现农机的路径跟踪控制;其中:
δfinal=min(δq+δm,δmax)
式中,δmax为农机前轮最大转角。
下面结合图1-图7以2个仿真试验说明本发明的实际控制效果。
以东方红LF1104-C拖拉机的实车数据建立车辆运动学模型,并在Carsim和Simulink联合仿真平台上进行仿真试验,行车控制模块的主要参数如表1所示:
表1行车控制模块的主要参数
图5是根据步骤(2)确定的不同车速v下前馈补偿角δq与车辆横向误差ΔX之间的关系图,自适应前馈补偿器根据车速v和横向误差ΔX,便可得到对应的前馈补偿角δq。
为了验证本发明用于农机自动驾驶的自适应前馈模型预测控制方法的效果,设计了两种不同的目标路径(直线换道路径和圆周路径)用于仿真试验,并将本发明提出的自适应前馈模型预测控制(自适应前馈MPC)和普通模型预测控制(普通MPC)进行了对比。图6和图7分别为直线换道路径和圆周路径下两种控制方法仿真结果对比。由仿真结果可知,相比于普通MPC,本发明自适应前馈MPC在跟踪换道路径时性能提升明显,稳定后的横向和航向平均误差分别减少50.9%和18.0%,误差标准差减少明显;相比于普通MPC,本发明自适应前馈MPC跟踪圆周路径时,拖拉机运行稳定后横向和航向平均误差分别减小1.4%和3.1%,误差标准差稍有减少。仿真试验结果表明本发明的路径跟踪控制方法相比于普通MPC有较好的路径跟踪效果,表2为两种路径跟踪的结果对比。
表2是两种路径跟踪的结果对比
所述实施例为本发明的优选的实施方式,但本发明并不限于上述实施方式,在不背离本发明的实质内容的情况下,本领域技术人员能够做出的任何显而易见的改进、替换或变型均属于本发明的保护范围。
Claims (8)
4.根据权利要求1所述的用于农机自动驾驶的自适应前馈模型预测控制方法,其特征在于,还包括:当转角传感器实时反馈的实际前轮转角,等于最终前轮转角δfinal时,转向结束,实现农机的路径跟踪控制。
7.一种实现权利要求1-任一项所述的用于农机自动驾驶的自适应前馈模型预测控制方法的控制系统,其特征在于,包括:
导航定位模块,获取农机行驶状态信息;
行车控制模块,根据农机行驶状态信息得到最终前轮转角δfinal;
转角传感器,实时反馈实际前轮转角;
所述最终前轮转角δfinal和实际前轮转角均传输给转向执行机构,用于控制农机转向。
8.根据权利要求7所述的控制系统,其特征在于,所述行车控制模块包括模型预测控制器和自适应前馈控制器,所述自适应前馈控制器用于确定前馈补偿角δq,所述模型预测控制器用于求解前轮转角δm。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111214177.8A CN114047748B (zh) | 2021-10-19 | 2021-10-19 | 用于农机自动驾驶的自适应前馈模型预测控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111214177.8A CN114047748B (zh) | 2021-10-19 | 2021-10-19 | 用于农机自动驾驶的自适应前馈模型预测控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114047748A true CN114047748A (zh) | 2022-02-15 |
CN114047748B CN114047748B (zh) | 2024-05-14 |
Family
ID=80205676
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111214177.8A Active CN114047748B (zh) | 2021-10-19 | 2021-10-19 | 用于农机自动驾驶的自适应前馈模型预测控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114047748B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116300410A (zh) * | 2023-05-25 | 2023-06-23 | 武汉理工大学 | 数据驱动前馈加反馈补偿的转角优化方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110673598A (zh) * | 2019-09-29 | 2020-01-10 | 哈尔滨工程大学 | 一种水面无人艇智能路径跟踪控制方法 |
CN111845738A (zh) * | 2020-06-22 | 2020-10-30 | 江苏大学 | 基于双模型复合的车辆路径跟踪控制方法 |
AU2020104234A4 (en) * | 2020-12-22 | 2021-03-11 | Qingdao Agriculture University | An Estimation Method and Estimator for Sideslip Angle of Straight-line Navigation of Agricultural Machinery |
CN113359710A (zh) * | 2021-05-21 | 2021-09-07 | 江苏大学 | 一种基于los理论的农机路径跟踪方法 |
CN113433942A (zh) * | 2021-06-30 | 2021-09-24 | 南京理工大学 | 一种基于最优航向角的长轴车辆路径跟踪控制方法 |
-
2021
- 2021-10-19 CN CN202111214177.8A patent/CN114047748B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110673598A (zh) * | 2019-09-29 | 2020-01-10 | 哈尔滨工程大学 | 一种水面无人艇智能路径跟踪控制方法 |
CN111845738A (zh) * | 2020-06-22 | 2020-10-30 | 江苏大学 | 基于双模型复合的车辆路径跟踪控制方法 |
AU2020104234A4 (en) * | 2020-12-22 | 2021-03-11 | Qingdao Agriculture University | An Estimation Method and Estimator for Sideslip Angle of Straight-line Navigation of Agricultural Machinery |
CN113359710A (zh) * | 2021-05-21 | 2021-09-07 | 江苏大学 | 一种基于los理论的农机路径跟踪方法 |
CN113433942A (zh) * | 2021-06-30 | 2021-09-24 | 南京理工大学 | 一种基于最优航向角的长轴车辆路径跟踪控制方法 |
Non-Patent Citations (1)
Title |
---|
陈威;廖文浩;刘明春;: "基于MPC的自动驾驶车辆横向路径跟踪控制", 南昌大学学报(工科版), no. 03, 28 September 2020 (2020-09-28) * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116300410A (zh) * | 2023-05-25 | 2023-06-23 | 武汉理工大学 | 数据驱动前馈加反馈补偿的转角优化方法及系统 |
CN116300410B (zh) * | 2023-05-25 | 2023-08-22 | 武汉理工大学 | 数据驱动前馈加反馈补偿的转角优化方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN114047748B (zh) | 2024-05-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111638712B (zh) | 自动驾驶车辆横向运动控制方法、装置和自动驾驶车辆 | |
CN110989625B (zh) | 一种车辆路径跟踪控制方法 | |
CN110568758A (zh) | 一种自动驾驶汽车的参数自适应横向运动lqr控制方法 | |
CN110244735A (zh) | 移动机器人跟踪预定轨迹的启发式动态规划控制方法 | |
CN109884900A (zh) | 基于自适应模型预测控制的收获机路径跟踪控制器的设计方法 | |
CN111538328A (zh) | 一种用于自主驾驶车辆避障轨迹规划与跟踪控制的优先级分层预测控制方法 | |
Guillet et al. | Formation control of agricultural mobile robots: A bidirectional weighted constraints approach | |
CN112693449A (zh) | 一种无人车辆极限工况下横纵向耦合控制方法 | |
CN115236973A (zh) | 基于pso李雅普诺夫函数的agv轨迹跟踪控制方法 | |
CN114047748A (zh) | 用于农机自动驾驶的自适应前馈模型预测控制方法及系统 | |
CN115598983A (zh) | 一种考虑时变时延的无人车横纵向协同控制方法及装置 | |
CN113741450B (zh) | 一种车辆自动驾驶横向自适应控制方法 | |
CN114200925B (zh) | 基于自适应时域模型预测的拖拉机路径跟踪控制方法及系统 | |
Xie et al. | Parameter self‐learning feedforward compensation‐based active disturbance rejection for path‐following control of self‐driving forklift trucks | |
CN115407656A (zh) | 基于动态自适应lqr的智能农机自主作业控制方法及系统 | |
CN113311698B (zh) | 车道保持控制方法、控制装置和车辆 | |
CN115167135A (zh) | 反馈与模型前馈串级的无人驾驶车辆自趋优位姿控制系统 | |
CN116691668A (zh) | 一种大型智能车辆的横向控制方法 | |
CN114740845A (zh) | 一种基于浸入与不变流形车辆跟踪控制方法 | |
CN114253241B (zh) | 用于工业智能小车的路径跟踪方法 | |
Schwartz et al. | Analysis of a cascaded MPC structure for vehicle motion control | |
CN115542731A (zh) | 一种自适应mpc无人驾驶车辆路径跟踪控制方法 | |
CN114442601B (zh) | 一种无人驾驶车辆跟踪控制方法及装置 | |
CN113985895B (zh) | 一种基于最优化的agv路径跟踪方法 | |
CN114194216B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |