CN109799814B - 基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法 - Google Patents
基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法 Download PDFInfo
- Publication number
- CN109799814B CN109799814B CN201811636490.9A CN201811636490A CN109799814B CN 109799814 B CN109799814 B CN 109799814B CN 201811636490 A CN201811636490 A CN 201811636490A CN 109799814 B CN109799814 B CN 109799814B
- Authority
- CN
- China
- Prior art keywords
- track
- vehicle
- control
- formula
- tracking
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 238000013461 design Methods 0.000 title claims abstract description 9
- 238000005457 optimization Methods 0.000 claims abstract description 18
- 230000008569 process Effects 0.000 claims abstract description 10
- 238000005096 rolling process Methods 0.000 claims abstract description 5
- 238000006243 chemical reaction Methods 0.000 claims abstract description 4
- 230000001133 acceleration Effects 0.000 claims description 10
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000013459 approach Methods 0.000 abstract description 4
- 238000004088 simulation Methods 0.000 description 12
- 238000004422 calculation algorithm Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法,车辆控制技术领域。该方法首先根据考虑滑移的履带车辆运动学模型建立状态空间方程,然后根据设定的目标函数进行标准二次型转化;最后在下一个控制周期T内***通过目标函数的优化过程计算出新的控制序列,反复进行滚动优化,从而实现轨迹跟踪控制。本发明的方法建立的控制器对连续和离散点路径都具有良好的跟踪能力,特别是在低速跟踪过程中,行驶速度稳定在期望速度附近,直线跟踪稳态误差趋近于0,行驶轨迹平顺。
Description
技术领域
本发明涉及车辆控制技术领域,具体涉及一种基于运动学模型的轨迹跟踪控制器的设计方法。
背景技术
目前国内外研究学者对履带式自主平台的轨迹跟踪控制进行了大量研究,但存在以下几点不足:
1.研究对象都是低速运动的小型履带式移动机器人,仿真车速不超过2m/s。并且仿真时给定的轨迹过于单一,普遍是跟踪一段直线或者圆形轨迹。因此控制算法在车辆高速运动条件下跟踪复杂轨迹时的准确性有待进一步验证。
2.控制算法主要基于理想的车辆运动学模型进行构建,没有考虑到打滑对车辆运动造成的影响,在复杂道路条件下跟踪精度会有所降低。
3.仿真结果没有体现出跟踪过程中车辆速度和加速度的变化情况,评价指标只有跟踪轨迹的精确度,缺乏对车辆行驶稳定性和跟踪速度的考虑。
由于模型预测控制算法能够有效结合车辆的约束条件对目标函数进行反复的在线实时优化,并能根据***实际状态与预测控制之间的误差对预测值进行实时修正,能够有效克服***不确定性产生的扰动,消除模型误差,非常适合于求解不能精确建立数学模型且存在约束条件的控制***。因而基于模型预测控制算法来设计履带无人车辆的轨迹跟踪控制器,可使无人车辆在高速运动和非结构化道路环境下能够准确、稳定的跟踪参考轨迹。
发明内容
有鉴于此,本发明提供了一种基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法,该方法建立的控制器对连续和离散点路径都具有良好的跟踪能力,特别是在低速跟踪过程中,行驶速度稳定在期望速度附近,直线跟踪稳态误差趋近于0,行驶轨迹平顺。
一种基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法,该方法的实现步骤如下:
第一步:根据考虑滑移的履带车辆运动学模型建立状态空间方程;
第二步:根据设定的目标函数进行标准二次型转化;
第三步:在下一个控制周期T内***通过目标函数的优化过程计算出新的控制序列,反复进行滚动优化,从而实现轨迹跟踪控制。
进一步地,所述第一步中建立状态空间方程的过程如下:
考虑滑移的履带车辆运动学模型如式(1.1)所示
其中,
将其表示为如下的非线性模型:
将式(1.3)在工作点(ξr,μr)处进行一阶近似泰勒展开线性***,得
将工作点(ξr,μr)代入模型(1.3),式(1.4)减式(1.3),得线性化误差方程
应用一阶差商的方法将式(1.5)线性时变***进行离散化,得到
其中,
其中,T为采样时间,r为主动轮半径,B为履带中心距,iL为左侧履带滑移率,iR为右侧履带滑移率,α为车辆打滑角;
选取***输出量为:
其中,各矩阵表示如下:
其中,Ak,t由式(1.7)可以得到,Bk,t由式(1.8)可以得到;
为了进一步降低模型的计算复杂度,需要做出以下定义:
进一步地,所述第二步中设定的目标函数为
目标函数转化为如下标准二次型。
其中,已知状态量个数n=3,控制量个数m=2,输出量个数p=3,设定预测时域Hp=135,控制时域Hc=35,控制周期T=0.1s,可以得到;
对于目标函数的优化求解需要符合车辆运动学和动力学约束条件,为了发挥履带车辆的运动性能并能保证车辆的稳定性,设定如下约束条件:
(a)两侧履带转速约束
Umin-U(t-1)≤MΔU(t)≤Umax-U(t-1) (1.20)
(b)转速增量约束
ΔUmin≤ΔU(t)≤ΔUmax (1.21)
(c)纵向加速度约束
A1ΔU≤b1 (1.22)
(d)侧向加速度约束
根据以上建立的目标优化函数和设定的约束条件,将线性时变预测控制问题转化为如下的标准二次规划问题;
有益效果:
本发明的控制器在高速和低速条件下对连续和离散点路径都具有良好的跟踪能力,特别是在低速跟踪过程中,行驶速度稳定在期望速度附近,直线跟踪稳态误差趋近于0,行驶轨迹平顺;此外,纵向和侧向加速度以及横摆加速度和角速度都能限定在约束范围,车辆具有良好的行驶稳定性,跟踪效果能够满足车辆自主行驶的要求。
附图说明
图1为本发明实现的步骤流程图;
图2为参考轨迹和仿真轨迹变化曲线图。
具体实施方式
下面结合附图并举实施例,对本发明进行详细描述。
如附图1所示,本发明提供了一种基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法,该方法的实现步骤如下:
第一步:根据考虑滑移的履带车辆运动学模型建立状态空间方程;
考虑滑移的履带车辆运动学模型如式(1.1)所示。
其中,
将其表示为如下的非线性模型:
将式(1.3)在工作点(ξr,μr)处进行一阶近似泰勒展开线性***,得
将工作点(ξr,μr)代入模型(1.3),式(1.4)减式(1.3),得线性化误差方程
应用一阶差商的方法将式(1.5)线性时变***进行离散化,得到
其中,
其中,T为采样时间,r为主动轮半径,B为履带中心距,iL为左侧履带滑移率,iR为右侧履带滑移率,α为车辆打滑角;
选取***输出量为:
其中,各矩阵表示如下:
其中,Ak,t由式(1.7)可以得到,Bk,t由式(1.8)可以得到;
为了进一步降低模型的计算复杂度,需要做出以下定义:
第二步:根据设定的目标函数进行标准二次型转化;
目标函数转化为如下标准二次型。
其中,已知状态量个数n=3,控制量个数m=2,输出量个数p=3,设定预测时域Hp=135,控制时域Hc=35,控制周期T=0.1s,可以得到;
对于目标函数的优化求解需要符合车辆运动学和动力学约束条件,为了发挥履带车辆的运动性能并能保证车辆的稳定性,设定如下约束条件:
(a)两侧履带转速约束
Umin-U(t-1)≤MΔU(t)≤Umax-U(t-1) (1.20)
(b)转速增量约束
ΔUmin≤ΔU(t)≤ΔUmax (1.21)
(c)纵向加速度约束
A1ΔU≤b1 (1.22)
(d)侧向加速度约束
根据以上建立的目标优化函数和设定的约束条件,将线性时变预测控制问题转化为如下的标准二次规划问题;
第三步:在下一个控制周期T内***通过目标函数的优化过程计算出新的控制序列,反复进行滚动优化,从而实现轨迹跟踪控制。
为了验证轨迹跟踪控制器在高速和复杂路径条件下的轨迹跟踪能力,设计了高速和低速条件下复杂连续曲线和离散点的跟踪仿真实验。无人车辆相关结构参数如表1所示
表1履带无人车辆结构参数
其中M为整车质量,L为履带接地长,B为履带中心距,b为履带板宽度,IZ为车辆绕Z轴的转动惯量,f为滚动阻力系数,μ为履带与地面之间的摩擦系数,K为履带与地面之间的剪切模量,r为主动轮半径,Cx、Cy分别为质心与车辆局部坐标系的横向和纵向距离。
其中,航向角的定义为:X轴正方向为0°,Y轴正方向为90°,逆时针方向依次增加,取值范围为[0°,360°)。
进行2m/s速度下连续曲线的轨迹跟踪仿真:仿真车速设置为2m/s,仿真时间为90s,采用四阶龙格库塔算法,仿真步长设置为0.1s。在0-20s内跟踪直线,20s-50s内跟踪圆形,50s-100s跟踪双移线,得到的仿真结果:
如附图2所示,控制器具有良好的路径覆盖程度,在直线跟踪时,Y方向的误差趋近于0。跟踪圆形轨迹和双移线轨迹的误差较大,原因在于车辆前进方向不断改变,车辆难以预测未来一段时间的状态变化,这可以通过增加预测时域Hp或减小仿真步长T来提高跟踪精度,但相应的会增加计算时间,降低控制***的实时性,预测时域和仿真步长需要进行多次仿真实验方可确定。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (2)
1.基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法,其特征在于,该方法的实现步骤如下:
第一步:根据考虑滑移的履带车辆运动学模型建立状态空间方程;
第二步:根据设定的目标函数进行标准二次型转化;
第三步:在下一个控制周期T内***通过目标函数的优化过程计算出新的控制序列,反复进行滚动优化,从而实现轨迹跟踪控制;
所述第一步中建立状态空间方程的过程如下:
考虑滑移的履带车辆运动学模型如式(1.1)所示
其中,
将其表示为如下的非线性模型:
将式(1.3)在工作点(ξr,μr)处进行一阶近似泰勒展开线性***,得
将工作点(ξr,μr)代入模型(1.3),式(1.4)减式(1.3),得线性化误差方程
应用一阶差商的方法将式(1.5)线性时变***进行离散化,得到
其中,
其中,T为采样时间,r为主动轮半径,B为履带中心距,iL为左侧履带滑移率,iR为右侧履带滑移率,α为车辆打滑角;
选取***输出量为:
其中,各矩阵表示如下:
其中,Ak,t由式(1.7)可以得到,Bk,t由式(1.8)可以得到;
为了进一步降低模型的计算复杂度,需要做出以下定义:
2.如权利要求1所述的轨迹跟踪控制器设计方法,其特征在于,所述第二步中设定的目标函数为:
目标函数转化为如下标准二次型:
其中,已知状态量个数n=3,控制量个数m=2,输出量个数p=3,设定预测时域Hp=135,控制时域Hc=35,控制周期T=0.1s,可以得到;
Pt=ε(t)TQeε(t) (1.19)
对于目标函数的优化求解需要符合车辆运动学和动力学约束条件,为了发挥履带车辆的运动性能并能保证车辆的稳定性,设定如下约束条件:
(a)两侧履带转速约束
Umin-U(t-1)≤MΔU(t)≤Umax-U(t-1) (1.20)
(b)转速增量约束
ΔUmin≤ΔU(t)≤ΔUmax (1.21)
(c)纵向加速度约束
A1ΔU≤b1 (1.22)
(d)侧向加速度约束
根据以上建立的目标优化函数和设定的约束条件,将线性时变预测控制问题转化为如下的标准二次规划问题;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811636490.9A CN109799814B (zh) | 2018-12-29 | 2018-12-29 | 基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811636490.9A CN109799814B (zh) | 2018-12-29 | 2018-12-29 | 基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109799814A CN109799814A (zh) | 2019-05-24 |
CN109799814B true CN109799814B (zh) | 2022-03-25 |
Family
ID=66558109
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811636490.9A Active CN109799814B (zh) | 2018-12-29 | 2018-12-29 | 基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109799814B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110286683B (zh) * | 2019-07-15 | 2020-07-24 | 北京科技大学 | 一种履带式移动机器人的自主行驶路径跟踪控制方法 |
CN113064412B (zh) * | 2019-12-31 | 2023-04-25 | 北京车和家信息技术有限公司 | 路径跟踪方法、装置、车辆及可读存储介质 |
CN111176297A (zh) * | 2020-01-21 | 2020-05-19 | 大连海事大学 | 一种基于多目标dmc预测控制算法的地铁列车跟踪控制方法及*** |
CN111324146B (zh) * | 2020-03-09 | 2023-06-13 | 河海大学常州校区 | 一种水下巡检机器人的轨迹跟踪控制方法 |
CN111428314B (zh) * | 2020-04-09 | 2023-03-28 | 中国北方车辆研究所 | 一种履带车辆负重轮布局设计方法 |
CN112069599B (zh) * | 2020-08-28 | 2023-08-22 | 北京科技大学 | 一种履带车辆行驶性能可靠性预测方法 |
CN112114588A (zh) * | 2020-08-31 | 2020-12-22 | 南京航空航天大学 | 一种平衡车及其控制方法 |
CN112684793B (zh) * | 2020-12-03 | 2022-06-28 | 南京理工大学 | 一种离散***中的机器人零半径过弯的轨迹跟踪控制方法 |
CN113467470B (zh) * | 2021-07-23 | 2023-03-03 | 西安理工大学 | 一种无人自主小车的轨迹跟踪控制方法 |
CN114355882A (zh) * | 2021-11-30 | 2022-04-15 | 中国北方车辆研究所 | 基于动力学模型的履带无人车辆轨迹跟踪控制器设计方法 |
CN114355954A (zh) * | 2022-03-21 | 2022-04-15 | 北京理工大学 | 一种无人履带车辆转向过程的跟踪控制方法和*** |
CN114510063B (zh) * | 2022-04-06 | 2022-07-15 | 北京理工大学 | 一种无人履带车辆及其轨迹跟踪控制方法和*** |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108454623A (zh) * | 2018-01-22 | 2018-08-28 | 大连理工大学 | 一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法 |
CN108569336A (zh) * | 2018-04-26 | 2018-09-25 | 武汉理工大学 | 在动力学约束下基于车辆运动学模型转向控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011032208A1 (en) * | 2009-09-15 | 2011-03-24 | The University Of Sydney | A system and method for autonomous navigation of a tracked or skid-steer vehicle |
GB201100843D0 (en) * | 2011-01-18 | 2011-08-17 | Bae Systems Plc | Trajectory planning |
-
2018
- 2018-12-29 CN CN201811636490.9A patent/CN109799814B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108454623A (zh) * | 2018-01-22 | 2018-08-28 | 大连理工大学 | 一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法 |
CN108569336A (zh) * | 2018-04-26 | 2018-09-25 | 武汉理工大学 | 在动力学约束下基于车辆运动学模型转向控制方法 |
Non-Patent Citations (1)
Title |
---|
基于模型预测控制的履带式无人平台轨迹跟踪控制算法研究;杨福威 等;《舰船电子工程》;20180331;第38卷(第3期);第44-50页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109799814A (zh) | 2019-05-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109799814B (zh) | 基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法 | |
CN109318905B (zh) | 一种智能汽车路径跟踪混合控制方法 | |
CN110780594B (zh) | 一种智能车的路径跟踪方法及*** | |
CN108227491B (zh) | 一种基于滑模神经网络的智能车轨迹跟踪控制方法 | |
CN104881030B (zh) | 基于快速终端滑模原理的无人车侧纵向耦合跟踪控制方法 | |
CN105320129A (zh) | 一种无人驾驶自行车轨迹跟踪控制的方法 | |
CN103970137A (zh) | 基于自抗扰的alv横向位移跟踪***控制方法 | |
Oyama et al. | Model predictive parking control for nonholonomic vehicles using time-state control form | |
Nayl et al. | Switching model predictive control for an articulated vehicle under varying slip angle | |
Song et al. | Combined longitudinal and lateral control for automated lane guidance of full drive-by-wire vehicles | |
CN113341719A (zh) | 一种融合teb算法和模糊控制的agv轨迹跟踪控制方法 | |
CN113581201A (zh) | 一种基于势场模型的无人汽车避撞控制方法及*** | |
Martin et al. | Design and simulation of control strategies for trajectory tracking in an autonomous ground vehicle | |
Qinpeng et al. | Path tracking control of wheeled mobile robot based on improved pure pursuit algorithm | |
CN113848905B (zh) | 基于神经网络和自适应控制的移动机器人轨迹跟踪方法 | |
Tao et al. | Design of trajectory tracking controller of unmanned tracked vehicles based on torque control | |
Zhu et al. | Nonlinear model predictive path tracking control for autonomous vehicles based on orthogonal collocation method | |
Chu et al. | Autonomous high-speed overtaking of intelligent chassis using fast iterative model predictive control | |
Chang et al. | An adaptive MPC trajectory tracking algorithm for autonomous vehicles | |
Dawood et al. | A nonlinear model predictive controller for autonomous driving | |
Jiang et al. | Learning based predictive error estimation and compensator design for autonomous vehicle path tracking | |
Chang et al. | Adaptive tracking controller based on the PID for mobile robot path tracking | |
CN116225004A (zh) | 一种六轮独立驱动独立转向机器人的避障方法 | |
Chen et al. | An overtaking obstacle algorithm for autonomous driving based on dynamic trajectory planning | |
Vilca et al. | An overall control strategy based on target reaching for the navigation of an urban electric vehicle |
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 |