CN117519190B - 一种新的铰接车辆控制方法 - Google Patents
一种新的铰接车辆控制方法 Download PDFInfo
- Publication number
- CN117519190B CN117519190B CN202311629077.0A CN202311629077A CN117519190B CN 117519190 B CN117519190 B CN 117519190B CN 202311629077 A CN202311629077 A CN 202311629077A CN 117519190 B CN117519190 B CN 117519190B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- coordinate system
- point
- deviation
- reference path
- 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 18
- 239000013598 vector Substances 0.000 claims description 10
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000003379 elimination reaction Methods 0.000 claims description 2
- 230000008569 process Effects 0.000 description 5
- 230000009471 action Effects 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 230000036544 posture Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000005065 mining Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明属于自动控制类技术领域,公开了一种新的铰接车辆控制方法。该方法包括:S100:基于当前位姿及参考路径计算横向位置偏差及横摆角度偏差;S200:基于当前位姿及参考路径计算曲率偏差;S300:构建运动学误差模型解出控制量。该控制模型也是以车辆前轮中点为参考中心,但在误差模型中,除了横向位置偏差、横摆角度偏差等,还创造性地提出了曲率偏差的概念,该曲率偏差能够准确描述铰接车辆前后部分运动轨迹与规划曲线符合准确度的问题,从而通过较少的状态变量就可完整描述铰接车辆的控制误差模型,充分利用了“单中心”简单以及“双中心”能够解决车辆前后部分运动轨迹与规划曲线一致符合的优点。
Description
技术领域
本发明属于自动控制类技术领域,尤其涉及一种新的铰接车辆控制方法。
背景技术
农机、装卸车、矿区运输车等车辆的自主控制需要回答3个基础问题:我在哪?我去哪?怎么去?而对车辆进行转向控制的自动驾驶系统属于第3个问题的范畴。解决怎么去的问题。第1步就需要构建控制模型。对于铰接转向的车辆而言,因其特殊的2段铰接的结构特点,通用的“自行车模型”并不适用,因此需要基于运动及几何约束,单独构建合适的运动学控制模型。
对于铰接车辆的控制模型,一般是基于车辆的非完整性约束方程与2段刚体运动约束方程,构建基于铰接转向车辆前轮中点处的“单中心”误差模型,或是基于铰接转向车辆前轮中点与后轮中点的“双中心”误差模型。前者虽然简单,但当车辆沿曲线行驶的过程中,因其铰接转向结构,会导致车辆前半部分沿着曲线运动、而车辆后半部分明显偏离规划曲线的问题。而后者,非常容易导致模型变量冗余的问题,会给后续求解带来一定的难度。
发明内容
为了解决上述技术问题,本发明提供如下技术方案:
一种新的铰接车辆控制方法,包括以下步骤,
S100:基于当前位姿及参考路径计算横向位置偏差及横摆角度偏差;
S200:基于当前位姿及参考路径计算曲率偏差;
S300:构建运动学误差模型解出控制量。
优选的,所述的步骤S100中,
假设车辆的当前位姿为P0(xi,yi,θi),参考路径为Γ(xr(s),yr(s)),其中s为参数,如果此时刻离当前点最近的点为P*(xr(s*),yr(s*));
当前位姿为P0(xi,yi,θi):xi-世界坐标系中的x坐标值,yi-世界坐标系中的y坐标值,θi-车辆坐标系(以车辆前轮中点为原点,以车头方向为X轴正,符合右手法则)在世界坐标系中的倾角,即车辆的当前姿态;
参考路径为Γ(xr(s),yr(s)):xr(s)-世界坐标系下的参考路径x坐标表达式,yr(s)-世界坐标系下的参考路径y坐标表达式,s-为自变量参数;
s*:参考路径中离当前点最近的点对应的自变量参数;
则P*(xr(s*),yr(s*))处的切线单位向量为
则P0(xi,yi,θi)处的绝对偏差向量为
则P0(xi,yi,θi)处的横向位置偏差εy为与/>的向量积:
则P0(xi,yi,θi)处的横摆角度偏差εθ:
优选的,所述的步骤S200中,
P*(xr(s*),yr(s*))处的路径曲率:
基于车辆前轮中点、后轮中点至铰接处的距离及铰接角度容易求出与两中点相切的近似圆,其半径为r,
则P0(xi,yi,θi)处的曲率偏差:
优选的,所述的步骤S300中,
非完整性约束方程:
2段刚体约束方程:
(x0,y0)、(x1,y1)分别为前轮中点、后轮中点在世界坐标系下的坐标值,θ0、θ1分别为前轮中点坐标系(以前轮中点为原点,以车辆正向为x正,符合右手法则)后轮中点坐标系(以后轮中点为原点,以车辆正向为x正,符合右手法则)在世界坐标下的倾角,即车辆前后两部分的当前姿态;
根据非完整性约束方程及铰接车辆2段刚体约束方程可得误差向量与其微分/>之间的关系为
其中L0为前轴距离(铰接点至前轮中点的距离),L1为后轴距离,总轴距L=L0+L1其为了消掉对状态变量稍作处理,得:
v0:车辆前部分的速度;
γ:铰接处的角度;
铰接处的角速度;
铰接处的角加速度;
对方程采用标准的LQR或MPC进行求解,得到控制量
与现有技术相比,本发明的有益效果是:为了解决铰车转向车辆前后部分运动轨迹与规划曲线一致符合的问题,同时也不希望控制模型中引入额外的约束从而降低后续求解的难度。充分考虑铰车转向车辆的结构特点,提出了一种新的控制模型。该控制模型也是以车辆前轮中点为参考中心,但在误差模型中,除了横向位置偏差、横摆角度偏差等,还创造性地提出了曲率偏差的概念,该曲率偏差能够准确描述铰接车辆前后部分运动轨迹与规划曲线符合准确度的问题,从而通过较少的状态变量就可完整描述铰接车辆的控制误差模型,充分利用了“单中心”简单以及“双中心”能够解决车辆前后部分运动轨迹与规划曲线一致符合的优点。
本发明的工作原理:车体通过安装GNSS天线或其他定位数据测量装置,以及检测车辆实时铰接角度的角度传感器,或者通过安装于车身的惯性测量单元估算出铰接处的实时角度及角速度,从而代入模型公式,解决在曲线行驶过程中,车辆前后部分运动轨迹与路径符合的问题。
附图说明
附图用来提供对本发明的进一步理解,并且构成说明书的一部分,与本发明的实施例一起用于解释本发明,并不构成对本发明的限制。在附图中:
图1是本发明的流程示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明提供技术方案,具体流程图参照图1,该方法的具体执行过程如下。
车体上需安装有GNSS天线或其他定位数据测量装置,另外还需要安装检测车辆实时铰接角度的角度传感器,或者通过安装于车身的惯性测量单元估算出铰接处的实时角度及角速度。
1、基于当前位姿及参考路径计算横向位置偏差及横摆角度偏差:
假设车辆的当前位姿为P0(xi,yi,θi),参考路径为Γ(xr(s),yr(s)),其中s为参数。如果此时刻离当前点最近的点为P*(xr(s*),yr(s*));
当前位姿为P0(xi,yi,θi):xi-世界坐标系中的x坐标值,yi-世界坐标系中的y坐标值,θi-车辆坐标系(以车辆前轮中点为原点,以车头方向为X轴正,符合右手法则)在世界坐标系中的倾角,即车辆的当前姿态;
参考路径为Γ(xr(s),yr(s)):xr(s)-世界坐标系下的参考路径x坐标表达式,yr(s)-世界坐标系下的参考路径y坐标表达式,s-为自变量参数;
s*:参考路径中离当前点最近的点对应的自变量参数;
则P*(xr(s*),yr(s*))处的切线单位向量为
则P0(xi,yi,θi)处的绝对偏差向量为
则P0(xi,yi,θi)处的横向位置偏差εy为与/>的向量积:
则P0(xi,yi,θi)处的横摆角度偏差εθ:
2、基于当前位姿及参考路径计算曲率偏差:
P*(xr(s*),yr(s*))处的路径曲率:
基于车辆前轮中点、后轮中点至铰接处的距离及铰接角度容易求出与两中点相切的近似圆,其半径为r。
则P0(xi,yi,θi)处的曲率偏差:
3、构建运动学误差模型:
非完整性约束方程:
2段刚体约束方程:
(x0,y0)、(x1,y1)分别为前轮中点、后轮中点在世界坐标系下的坐标值,θ0、θ1分别为前轮中点坐标系(以前轮中点为原点,以车辆正向为x正,符合右手法则)后轮中点坐标系(以后轮中点为原点,以车辆正向为x正,符合右手法则)在世界坐标下的倾角,即车辆前后两部分的当前姿态。
根据非完整性约束方程及铰接车辆2段刚体约束方程可得误差向量与其微分/>之间的关系为
其中L0为前轴距离(铰接点至前轮中点的距离),L1为后轴距离,总轴距l=l0+L1其为了消掉对状态变量稍作处理,得:
v0:车辆前部分的速度;
γ:铰接处的角度;
铰接处的角速度;
铰接处的角加速度。
4、求解模型:
上述模型属于典型的1阶线性状态方程,可采用标准的LQR或MPC进行求解,得到控制量
LQR(Linear Quadratic Regulator,线性二次型调节器)与MPC(ModelPredictive Control,模型预测控制)是求解1阶线性状态方程2种常用的方法,前者属于一种全状态反馈控制,后者属于滚动优化控制,都是基于状态向量与输入的加权代价函数最小为优化目标,找出最优控制解。在matlab中都有成熟的工具箱可调用。
本实施例是针对铰接转向车辆控制模型的构建。即简单方便,又能解决在曲线行驶过程中,前后部分运动轨迹与路径符合的问题。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。
最后应说明的是:以上所述仅为本发明的优选实施例而已,并不用于限制本发明,尽管参照前述实施例对本发明进行了详细的说明,对于本领域的技术人员来说,其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (2)
1.一种新的铰接车辆控制方法,其特征在于,包括以下步骤:
S100:基于当前位姿及参考路径计算横向位置偏差及横摆角度偏差;
S200:基于当前位姿及参考路径计算曲率偏差;
S300:构建运动学误差模型解出控制量;
所述的步骤S100中,
假设车辆的当前位姿为P0(xi,yi,θi),参考路径为Γ(xr(s),yr(s)),其中s为参数,如果此时刻离当前点最近的点为P*(xr(s*),yr(s*));
当前位姿为P0(xi,yi,θi):xi-世界坐标系中的x坐标值,yi-世界坐标系中的y坐标值,θi-车辆坐标系,以车辆前轮中点为原点,以车头方向为X轴正,符合右手法则,在世界坐标系中的倾角,即车辆的当前姿态;
参考路径为Γ(xr(s),yr(s)):xr(s)-世界坐标系下的参考路径x坐标表达式,yr(s)-世界坐标系下的参考路径y坐标表达式,s-为自变量参数;
s*:参考路径中离当前点最近的点对应的自变量参数;
则P*(xr(s*),yr(s*))处的切线单位向量为
则P0(xi,yi,θi)处的绝对偏差向量为
则P0(xi,yi,θi)处的横向位置偏差εy为与/>的向量积:
则P0(xi,yi,θi)处的横摆角度偏差εθ:
所述的步骤S200中,
P*(xr(s*),yr(s*))处的路径曲率:
基于车辆前轮中点、后轮中点至铰接处的距离及铰接角度容易求出与两中点相切的近似圆,其半径为r,
则P0(xi,yi,θi)处的曲率偏差:
2.根据权利要求1所述的一种新的铰接车辆控制方法,其特征在于,所述的步骤S300中,
非完整性约束方程:
2段刚体约束方程:
(x0,y0)、(x1,y1)分别为前轮中点、后轮中点在世界坐标系下的坐标值,θ0、θ1分别为前轮中点坐标系,以前轮中点为原点,以车辆正向为x正,符合右手法则,后轮中点坐标系,以后轮中点为原点,以车辆正向为x正,符合右手法则,在世界坐标下的倾角,即车辆前后两部分的当前姿态;
根据非完整性约束方程及铰接车辆2段刚体约束方程可得误差向量 与
其微分之间的关系为
其中L0为前轴距离,铰接点至前轮中点的距离,L1为后轴距离,总轴距L=L0+L1其为了消掉对状态变量稍作处理,得:
v0:车辆前部分的速度;
γ:铰接处的角度;
铰接处的角速度;
铰接处的角加速度;
对方程采用标准的LQR或MPC进行求解,得到控制量
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311629077.0A CN117519190B (zh) | 2023-11-30 | 2023-11-30 | 一种新的铰接车辆控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311629077.0A CN117519190B (zh) | 2023-11-30 | 2023-11-30 | 一种新的铰接车辆控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN117519190A CN117519190A (zh) | 2024-02-06 |
CN117519190B true CN117519190B (zh) | 2024-04-26 |
Family
ID=89760740
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311629077.0A Active CN117519190B (zh) | 2023-11-30 | 2023-11-30 | 一种新的铰接车辆控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117519190B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104881025A (zh) * | 2015-04-10 | 2015-09-02 | 北京科技大学 | 一种地下矿用车辆的反应式导航控制方法 |
CN107045347A (zh) * | 2017-01-22 | 2017-08-15 | 无锡卡尔曼导航技术有限公司 | 用于农机无人驾驶的自动掉头路径规划及其控制方法 |
CN107085424A (zh) * | 2016-02-16 | 2017-08-22 | 通用汽车环球科技运作有限责任公司 | 用于自动驾驶的预瞄横向控制 |
CN107933686A (zh) * | 2016-10-19 | 2018-04-20 | 中车株洲电力机车研究所有限公司 | 一种多轴转向车辆跟踪中央车道线转向控制方法及系统 |
CN112965373A (zh) * | 2021-02-02 | 2021-06-15 | 上海华测导航技术股份有限公司 | 一种农用和矿用铰接式车辆路径跟踪控制方法 |
CN113671962A (zh) * | 2021-08-20 | 2021-11-19 | 湘潭大学 | 一种无人驾驶铰接式清扫车的横向控制方法 |
CN115167469A (zh) * | 2022-08-16 | 2022-10-11 | 合众新能源汽车有限公司 | 一种路径跟踪控制方法及装置 |
WO2022248012A1 (en) * | 2021-05-25 | 2022-12-01 | Volvo Truck Corporation | An adaptive path following algorithm for heavy-duty vehicles |
-
2023
- 2023-11-30 CN CN202311629077.0A patent/CN117519190B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104881025A (zh) * | 2015-04-10 | 2015-09-02 | 北京科技大学 | 一种地下矿用车辆的反应式导航控制方法 |
CN107085424A (zh) * | 2016-02-16 | 2017-08-22 | 通用汽车环球科技运作有限责任公司 | 用于自动驾驶的预瞄横向控制 |
CN107933686A (zh) * | 2016-10-19 | 2018-04-20 | 中车株洲电力机车研究所有限公司 | 一种多轴转向车辆跟踪中央车道线转向控制方法及系统 |
CN107045347A (zh) * | 2017-01-22 | 2017-08-15 | 无锡卡尔曼导航技术有限公司 | 用于农机无人驾驶的自动掉头路径规划及其控制方法 |
CN112965373A (zh) * | 2021-02-02 | 2021-06-15 | 上海华测导航技术股份有限公司 | 一种农用和矿用铰接式车辆路径跟踪控制方法 |
WO2022248012A1 (en) * | 2021-05-25 | 2022-12-01 | Volvo Truck Corporation | An adaptive path following algorithm for heavy-duty vehicles |
CN113671962A (zh) * | 2021-08-20 | 2021-11-19 | 湘潭大学 | 一种无人驾驶铰接式清扫车的横向控制方法 |
CN115167469A (zh) * | 2022-08-16 | 2022-10-11 | 合众新能源汽车有限公司 | 一种路径跟踪控制方法及装置 |
Non-Patent Citations (3)
Title |
---|
农用轮式铰接车辆滑模轨迹跟踪控制算法;赵翾,杨珏,张文明,曾珺;农业工程学报;20150531;第31卷(第10期);198-202 * |
基于预见位姿信息的铰接式车辆LQR-GA 路径跟踪控制;孟宇,汪钰,顾青,白国星;《农业机械学报》;20180630;第49卷(第6期);375-383 * |
无人驾驶铰接式车辆强化学习路径跟踪控制算法;邵俊恺;赵;杨珏;张文明;康翌婷;赵鑫鑫;;农业机械学报;20170325(第03期);376-381 * |
Also Published As
Publication number | Publication date |
---|---|
CN117519190A (zh) | 2024-02-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111638712B (zh) | 自动驾驶车辆横向运动控制方法、装置和自动驾驶车辆 | |
CN107415939B (zh) | 一种分布式驱动电动汽车转向稳定性控制方法 | |
Amidi et al. | Integrated mobile robot control | |
CN110568758B (zh) | 一种自动驾驶汽车的参数自适应横向运动lqr控制方法 | |
CN111240187B (zh) | 一种基于车辆误差模型的车辆轨迹跟踪控制算法 | |
CN110162046B (zh) | 基于事件触发型模型预测控制的无人车路径跟随方法 | |
CN112230651A (zh) | 一种基于分层控制理论的分布式无人车路径跟踪控制方法 | |
CN112622895B (zh) | 一种应用于自动驾驶的轨迹控制的预估控制方法 | |
CN112109732A (zh) | 一种智能驾驶自适应曲线预瞄方法 | |
CN113126623A (zh) | 一种考虑输入饱和的自适应动态滑模自动驾驶车辆路径跟踪控制方法 | |
CN117519190B (zh) | 一种新的铰接车辆控制方法 | |
CN110362088B (zh) | 一种适用于无人驾驶跨运车的循迹控制系统和方法 | |
CN115993089B (zh) | 基于pl-icp的在线四舵轮agv内外参标定方法 | |
CN116679725A (zh) | 一种基于改进lqr的拖拉机牵引机组作业路径跟踪控制方法 | |
CN113721454B (zh) | 一种铰接式车辆路径跟踪控制方法 | |
CN114291117B (zh) | 一种四轮转向无人车辆轨迹跟踪控制方法 | |
CN116560371A (zh) | 基于自适应模型预测控制的自动驾驶车辆路径跟踪方法 | |
CN115817509A (zh) | 一种基于ampc的多轴分布式驱动车辆转向辅助轨迹跟踪方法 | |
CN115167135A (zh) | 反馈与模型前馈串级的无人驾驶车辆自趋优位姿控制系统 | |
Yan et al. | A New Path Tracking Algorithm for Four-Wheel Differential Steering Vehicle | |
CN113671950B (zh) | 一种基于位姿收敛算法的车辆轨迹跟踪控制方法 | |
Xue et al. | Path tracking of orchard tractor based on linear time-varying model predictive control | |
CN114326728B (zh) | 高安全裕度的单agv智能车库路径跟踪控制系统及方法 | |
Wang et al. | Cooperative Control of Two-Vehicle Transportation Based on Time-Varying Distance Between Vehicles | |
CN113428142B (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 |