CN114995436B - 一种基于预瞄点的车辆路径跟踪侧向偏差计算方法 - Google Patents
一种基于预瞄点的车辆路径跟踪侧向偏差计算方法 Download PDFInfo
- Publication number
- CN114995436B CN114995436B CN202210656693.4A CN202210656693A CN114995436B CN 114995436 B CN114995436 B CN 114995436B CN 202210656693 A CN202210656693 A CN 202210656693A CN 114995436 B CN114995436 B CN 114995436B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- point
- coordinate system
- aiming
- track
- 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
- 238000004364 calculation method Methods 0.000 title claims abstract description 14
- 238000000034 method Methods 0.000 claims abstract description 12
- 206010034701 Peroneal nerve palsy Diseases 0.000 claims description 3
- 230000002035 prolonged effect Effects 0.000 claims description 3
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
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
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)
- Navigation (AREA)
Abstract
本发明公开了一种基于预瞄点的车辆路径跟踪侧向偏差计算方法,该方法首先通过将参考轨迹上的离散点的坐标由大地坐标系下转换成车辆坐标系下,预瞄距离很方便的确定了预瞄点,在求出轨迹上离车辆当前位置最近的点,进一步求得预瞄点的序号,从而计算出车辆经过预瞄时间到达的预瞄点与车辆实际到达的点的侧向偏差,再通过侧向偏差得出适当的前轮转角。本发明所述的方法原理简单易理解,且计算过程简便快速,能够很好的实现车辆跟踪参考轨迹的目的。
Description
技术领域
本发明涉及车辆路径跟踪控制技术领域,具体是一种基于预瞄点的车辆路径跟踪侧向偏差计算方法。
背景技术
近些年来,随着智能交通、物联网和人工智能等科学技术的快速发展,越来越多的机构及企业对辅助驾驶和无人驾驶引起了重视。路径跟踪控制作为智能车辆研究的重要组成部分,对智能驾驶的安全性起着至关重要的作用。路径跟踪控制主要是通过对车辆的转向控制系统和驱动控制系统来保证车辆的质心与期望路径中心线的横向误差为0,使车辆对期望路径有一个比较强的跟踪能力。目前基于驾驶员预瞄特性的路径跟踪控制方法被广大研究人员使用,通过计算车辆经过预瞄时间Tp后到达的实际位置与期望路径上的预瞄点的侧向偏差,然后再通过侧向偏差来实时计算出前轮转角从而达到路径跟踪控制。但是现有计算侧向偏差的方法存在计算复杂、结果不准确的问题。
发明内容
本发明的目的在于克服现有技术的不足,而提供一种基于预瞄点的车辆路径跟踪侧向偏差计算方法,该方法解决了现有车辆路径跟踪控制侧向偏差计算过程复杂、计算结果不准确的问题。
实现本发明目的的技术方案是:
一种基于预瞄点的车辆路径跟踪侧向偏差计算方法,设XAY为大地坐标系;xCy为车辆坐标系;xCy是以车辆质心为原点的车辆坐标系,车辆坐标系的x轴为车辆前进方向,y轴为驾驶员左侧与x轴垂直方向,车速为v,车速在x轴上的分量为u,车速在y轴上的分量为τ,Ψ为车辆当前时刻的航向角,β为车辆的质心侧偏角,C(XC,YC)点为车辆质心坐标;P点为车辆在位置C时的预瞄点,即车辆经过预瞄时间Tp后的目标位置;Q点为车辆经过预瞄时间Tp后到达的实际位置,弧CQ为车辆Tp时间内的轨迹,O点为汽车轨迹的圆心,θ为圆弧轨迹所对应的圆心角,为车辆的横摆角速度,M点是Q点过车辆坐标系x轴作垂足的交点,D点是延长车速与QM的交点;假设汽车在未来一段时间内保持不变的横摆角速度,且由于车速τ远小于u,则认为汽车合速速的大小保持不变,在该假设条件下,汽车在未来一段时间内将作匀速圆周运动,且汽车合速度的方向始终与其轨迹相切;若已知P点和Q点在车辆坐标系下的y坐标yP和yQ,则有ey=yP-yQ,ey为经过预瞄时间Tp后的车辆侧向偏差,分别求解yP和yQ,得到ey;具体步骤如下:
1)计算经过预瞄时间Tp后圆弧轨迹所对应的圆心角∠θ,若车辆横摆角速度为则圆心角/>
2)计算∠QCM:∠QCD为车辆经过Tp时间的圆弧轨迹对应的/>与车速v的夹角,由弦切角定理得/>∠DCM是车速v与车辆坐标系x轴的夹角,即车辆质心侧偏角β,有∠DCM=β,则有/>
3)计算Q点在车辆坐标系下的侧向坐标yQ,在三角形QCM中,已知 CM=Tp·u,则/>
4)将参考轨迹在大地坐标系下进行离散化,离散后的参考轨迹上的点用{J0,J 1,J2,…,J n}的序列来表示,其中J0、J n分别为参考轨迹的起点和终点,若是实时采集的参考轨迹,则n是无穷的,取n=200,参考轨迹上的点在大地坐标系下的坐标记为(Xi,Yi),其中0≤i≤n,且i和J的下标相对应,相邻两个点的距离记为L0,取L0=1m;
5)在参考轨迹上找到预瞄点P;
6)将参考轨迹上的点在大地坐标下的坐标转化为在车辆坐标系下的坐标;
7)找到参考轨迹上距离当前车辆位置最近的点JP;
8)确定预瞄点P序号,P=p+m为参考轨迹离散后的预瞄点序号,其中p为车辆当前距离参考轨迹最近点的序号,m为经过预瞄时间Tp后所增加的序号;
9)计算预瞄点P在车辆坐标系下的侧向坐标yP=-(Xp+m-XC)sinΨ+(Yp+m-YC)cosΨ,其中Xp+m为预瞄点P在大地坐标系下的横坐标,Yp+m为预瞄点P在大地坐标系下的纵坐标,则经过预瞄时间Tp后的车辆侧向偏差ey=yP-yQ;
经过上述步骤,计算出了跟踪参考轨迹的车辆侧向偏差。
本发明提供的一种基于预瞄点的车辆路径跟踪侧向偏差计算方法,该方法首先通过将参考轨迹上的离散点的坐标由大地坐标系下转换成车辆坐标系下,预瞄距离很方便的确定了预瞄点,在求出轨迹上离车辆当前位置最近的点,进一步求得预瞄点的序号,从而计算出车辆经过预瞄时间到达的预瞄点与车辆实际到达的点的侧向偏差,再通过侧向偏差得出适当的前轮转角。本发明所述的方法原理简单易理解,且计算过程简便快速,能够很好的实现车辆跟踪参考轨迹的目的。
附图说明
图1为本发明一种基于预瞄点的车辆路径跟踪侧向偏差计算方法的流程图;
图2为本发明实施例的大地坐标系XAY下的汽车轨迹预测图;
图3为参考轨迹上预瞄点的确定原理图。
具体实施方式
下面结合附图和实施例对本发明内容做进一步阐述,但不是对本发明的限定。
实施例:
如图1所示,一种基于预瞄点的车辆路径跟踪侧向偏差计算方法,首先通过将参考轨迹上的离散点的坐标由大地坐标系下转换成车辆坐标系下,然后用预瞄距离很方便的确定了预瞄点,在求出轨迹上离车辆当前位置最近的点,进一步求得预瞄点的序号,从而计算出车辆经过预瞄时间到达的预瞄点与车辆实际到达的点的侧向偏差,再通过侧向偏差得出适当的前轮转角,能够很好的实现车辆跟踪参考轨迹的目的。
真实驾驶员都具有一定的汽车轨迹预测能力,其能够感知汽车运动状态并预测汽车在一段时间后的大致位置。如图2所示,图2中包含大地坐标系XAY和车辆坐标系xCy;xCy是以车辆质心为原点的车辆坐标系,车辆坐标系的x轴为车辆前进方向,y轴为驾驶员左侧与x轴垂直方向,车速为v,车速在x轴上的分量为u,车速在y轴上的分量为τ,Ψ为车辆当前时刻的航向角,β为车辆的质心侧偏角,C(XC,YC)点为车辆质心坐标;P点为车辆在位置C时的预瞄点,即车辆经过预瞄时间Tp后的目标位置;Q点为车辆经过预瞄时间Tp后到达的实际位置,弧CQ为车辆Tp时间内的轨迹,O点为汽车轨迹的圆心,θ为圆弧轨迹所对应的圆心角,为车辆的横摆角速度,M点是Q点过车辆坐标系x轴作垂足的交点,D点是延长车速与QM的交点。
假设汽车在未来一段时间内保持不变的横摆角速度,且由于τ常远小于u可认为汽车合速度的大小保持不变。在该假设条件下,汽车在未来一段时间内将作匀速圆周运动,且汽车合速度的方向始终与其轨迹相切。则车辆侧向偏差计算方法,具体包括如下步骤:
1)计算经过预瞄时间Tp后圆弧轨迹所对应的圆心角∠θ,若车辆横摆角速度为则圆心角/>
2)计算∠QCM:∠QCD为车辆经过Tp时间的圆弧轨迹对应的/>与车速v的夹角,由弦切角定理得/>∠DCM是车速v与车辆坐标系x轴的夹角,即车辆质心侧偏角β,有∠DCM=β,则有/>
3)计算Q点在车辆坐标系下的侧向坐标yQ,在三角形QCM中,已知 CM=Tp·u,则/>
4)如图3所示,将参考轨迹在大地坐标系下进行离散化,离散后的参考轨迹上的点用{J0,J1,J2,…,Jn}的序列来表示,其中J0、Jn分别为参考轨迹的起点和终点,若是实时采集的参考轨迹,则n是无穷的,取n=200,参考轨迹上的点在大地坐标系下的坐标记为(Xi,Yi),其中0≤i≤n,且i和J的下标相对应,相邻两个点的距离记为L0,取L0=1m;
5)在参考轨迹上找到预瞄点P,图2所示,以车辆质心C为圆心,以预瞄距离为半径画圆,这个圆通常与参考轨迹往往有两个交点,通过预瞄距离画的圆与参考轨迹的交点并不一定是我们设定好的目标采集上的点,也有可能在两个点之间,通常取车辆行驶方向上前进的那个点为预瞄点;
6)将参考轨迹上的点在大地坐标下的坐标转化为在车辆坐标系下的坐标,假设车辆当前坐标为(Xc,Yc),车辆相对于大地坐标系的航向角为Ψ,则有参考轨迹上的点在车辆坐标系下的坐标为
7)找到参考轨迹上距离当前车辆位置最近的点JP(0≤p≤n),车辆质心与参考轨迹上的离散点距离可表示为遍历每个离散点,可得到参考轨迹上的点距离当前车辆位置最小距离dmin,则最近的点取为JP;
8)确定预瞄点P序号,由于弧段长约等于预瞄距离,则可得m的值为由于m是整数且为车辆前方的点,则可取/>可确定预瞄点序号
9)计算预瞄点P在车辆坐标系下的侧向坐标yP=-(Xp+m-XC)sinΨ+(Yp+m-YC)cosΨ,其中Xp+m为预瞄点P在大地坐标系下的横坐标,Yp+m为预瞄点P在大地坐标系下的纵坐标,则经过预瞄时间Tp后的车辆侧向偏差ey=yP-yQ;
经过上述步骤,计算出了车辆跟踪参考轨迹的侧向偏差,在后续的车辆控制中,根据跟踪参考轨迹的车辆侧向偏差计算出前轮转角,从而达到路径跟踪控制,实现车辆跟踪参考轨迹的目的。
以上实施例,首先通过将参考轨迹上的离散点的坐标由大地坐标系下转换成车辆坐标系下,然后用预瞄距离很方便的确定了预瞄点,在求出轨迹上离车辆当前位置最近的点,进一步求得预瞄点的序号,从而计算出车辆经过预瞄时间到达的预瞄点与车辆实际到达的点的侧向偏差,再通过侧向偏差得出适当的前轮转角,能够很好的实现车辆跟踪参考轨迹的目的。
Claims (2)
1.一种基于预瞄点的车辆路径跟踪侧向偏差计算方法,其特征在于,设XAY为大地坐标系;xCy为车辆坐标系;xCy是以车辆质心为原点的车辆坐标系,车辆坐标系的x轴为车辆前进方向,y轴为驾驶员左侧与x轴垂直方向,车速为v,车速在x轴上的分量为u,车速在y轴上的分量为τ,Ψ为车辆当前时刻的航向角,β为车辆的质心侧偏角,C(XC,YC)点为车辆质心坐标;P点为车辆在位置C时的预瞄点,即车辆经过预瞄时间Tp后的目标位置;Q点为车辆经过预瞄时间Tp后到达的实际位置,弧CQ为车辆Tp时间内的轨迹,O点为汽车轨迹的圆心,θ为圆弧轨迹所对应的圆心角,为车辆的横摆角速度,M点是Q点过车辆坐标系x轴作垂足的交点,D点是延长车速与QM的交点;假设汽车在未来一段时间内保持不变的横摆角速度,且由于车速τ远小于u,则认为汽车合速速的大小保持不变,在该假设条件下,汽车在未来一段时间内将作匀速圆周运动,且汽车合速度的方向始终与其轨迹相切;若已知P点和Q点在车辆坐标系下的y坐标yP和yQ,则有ey=yP-yQ,ey为经过预瞄时间Tp后的车辆侧向偏差,分别求解yP和yQ,得到ey;具体步骤如下:
1)计算经过预瞄时间Tp后圆弧轨迹所对应的圆心角∠θ,若车辆横摆角速度为则圆心角/>
2)计算∠QCM:∠QCD为车辆经过Tp时间的圆弧轨迹对应的/>与车速v的夹角,由弦切角定理得/>∠DCM是车速v与车辆坐标系x轴的夹角,即车辆质心侧偏角β,有∠DCM=β,则有/>
3)计算Q点在车辆坐标系下的侧向坐标yQ,在三角形QCM中,已知 CM=Tp·u,则/>
4)将参考轨迹在大地坐标系下进行离散化,离散后的参考轨迹上的点用{J0,J1,J2,…,Jn}的序列来表示,其中J0、Jn分别为参考轨迹的起点和终点,若是实时采集的参考轨迹,则n是无穷的,取n=200,参考轨迹上的点在大地坐标系下的坐标记为(Xi,Yi),其中0≤i≤n,且i和J的下标相对应,相邻两个点的距离记为L0;
5)在参考轨迹上找到预瞄点P;
6)将参考轨迹上的点在大地坐标下的坐标转化为在车辆坐标系下的坐标;
7)找到参考轨迹上距离当前车辆位置最近的点JP;
8)确定预瞄点P序号,P=p+m为参考轨迹离散后的预瞄点序号,其中p为车辆当前距离参考轨迹最近点的序号,m为经过预瞄时间Tp后所增加的序号;
9)计算预瞄点P在车辆坐标系下的侧向坐标yP=-(Xp+m-XC)sinΨ+(Yp+m-YC)cosΨ,其中Xp+m为预瞄点P在大地坐标系下的横坐标,Yp+m为预瞄点P在大地坐标系下的纵坐标,则经过预瞄时间Tp后的车辆侧向偏差ey=yP-yQ;
经过上述步骤,计算出了跟踪参考轨迹的车辆侧向偏差。
2.根据权利要求1所述的一种基于预瞄点的车辆路径跟踪侧向偏差计算方法,其特征在于,步骤中,所述的相邻两个点的距离L0=1m。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210656693.4A CN114995436B (zh) | 2022-06-10 | 2022-06-10 | 一种基于预瞄点的车辆路径跟踪侧向偏差计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210656693.4A CN114995436B (zh) | 2022-06-10 | 2022-06-10 | 一种基于预瞄点的车辆路径跟踪侧向偏差计算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114995436A CN114995436A (zh) | 2022-09-02 |
CN114995436B true CN114995436B (zh) | 2024-05-21 |
Family
ID=83032642
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210656693.4A Active CN114995436B (zh) | 2022-06-10 | 2022-06-10 | 一种基于预瞄点的车辆路径跟踪侧向偏差计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114995436B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115489518A (zh) * | 2022-09-26 | 2022-12-20 | 白犀牛智达(北京)科技有限公司 | 一种倒车控制方法和装置 |
CN116203833A (zh) * | 2023-02-09 | 2023-06-02 | 安徽海博智能科技有限责任公司 | 一种基于目标规划的无人矿车纵向分段pid控制方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102358287A (zh) * | 2011-09-05 | 2012-02-22 | 北京航空航天大学 | 一种用于车辆自动驾驶机器人的轨迹跟踪控制方法 |
WO2019052567A1 (zh) * | 2017-09-18 | 2019-03-21 | 中车株洲电力机车研究所有限公司 | 一种用于虚拟轨道车辆的虚拟道岔系统及方法 |
CN109823393A (zh) * | 2018-12-14 | 2019-05-31 | 清华大学苏州汽车研究院(相城) | 一种智能驾驶车辆轨迹跟踪控制方法 |
CN110006419A (zh) * | 2018-01-04 | 2019-07-12 | 郑州宇通客车股份有限公司 | 一种基于预瞄的车辆轨迹跟踪点确定方法 |
CN210011734U (zh) * | 2019-04-10 | 2020-02-04 | 吉林大学 | 一种基于多点跟踪的无人驾驶汽车路径跟踪控制装置 |
CN112486176A (zh) * | 2020-12-02 | 2021-03-12 | 吉林大学 | 一种考虑扰动的无人驾驶框架车轨迹跟踪控制方法 |
EP3909822A1 (fr) * | 2020-05-12 | 2021-11-17 | RENAULT s.a.s. | Module de calcul de trajectoire, dispositif de contrôle de trajectoire et procédé associés |
-
2022
- 2022-06-10 CN CN202210656693.4A patent/CN114995436B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102358287A (zh) * | 2011-09-05 | 2012-02-22 | 北京航空航天大学 | 一种用于车辆自动驾驶机器人的轨迹跟踪控制方法 |
WO2019052567A1 (zh) * | 2017-09-18 | 2019-03-21 | 中车株洲电力机车研究所有限公司 | 一种用于虚拟轨道车辆的虚拟道岔系统及方法 |
CN110006419A (zh) * | 2018-01-04 | 2019-07-12 | 郑州宇通客车股份有限公司 | 一种基于预瞄的车辆轨迹跟踪点确定方法 |
CN109823393A (zh) * | 2018-12-14 | 2019-05-31 | 清华大学苏州汽车研究院(相城) | 一种智能驾驶车辆轨迹跟踪控制方法 |
CN210011734U (zh) * | 2019-04-10 | 2020-02-04 | 吉林大学 | 一种基于多点跟踪的无人驾驶汽车路径跟踪控制装置 |
EP3909822A1 (fr) * | 2020-05-12 | 2021-11-17 | RENAULT s.a.s. | Module de calcul de trajectoire, dispositif de contrôle de trajectoire et procédé associés |
CN112486176A (zh) * | 2020-12-02 | 2021-03-12 | 吉林大学 | 一种考虑扰动的无人驾驶框架车轨迹跟踪控制方法 |
Non-Patent Citations (4)
Title |
---|
基于MPC的自动驾驶车辆横向路径跟踪控制;陈威;廖文浩;刘明春;;南昌大学学报(工科版);20200928(第03期);全文 * |
基于多点序列预瞄的自动驾驶汽车路径跟踪算法研究;赵凯;朱愿;冯明月;苏致远;郭宏达;;汽车技术;20180730(第11期);全文 * |
基于预瞄理论的智能驾驶客车轨迹跟踪控制方法研究;谢勇波;李熙;朱田;冯拔;;客车技术与研究;20181213(第06期);全文 * |
无人驾驶高速4WID-4WIS车辆路径跟踪单点预瞄控制;阮久宏;李贻斌;杨福广;荣学文;;重庆大学学报;20111015(第10期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114995436A (zh) | 2022-09-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114995436B (zh) | 一种基于预瞄点的车辆路径跟踪侧向偏差计算方法 | |
CN106926844B (zh) | 一种基于实时环境信息的动态自动驾驶换道轨迹规划方法 | |
CN105764773B (zh) | 用于控制车辆的方法 | |
US9625910B2 (en) | Lane changing apparatus and method of autonomous vehicle | |
KR101748269B1 (ko) | 자율 주행 차량의 조향 제어 방법 및 장치 | |
CN107943020B (zh) | 一种轮胎吊大车自动纠偏方法 | |
CN108279563B (zh) | 一种速度自适应的无人车轨迹跟踪pid控制方法 | |
CN107037818A (zh) | 一种无人驾驶汽车的路径跟踪方法 | |
CN109823393A (zh) | 一种智能驾驶车辆轨迹跟踪控制方法 | |
CN110398963A (zh) | 无轨导航纠偏控制方法、装置、存储介质及控制器 | |
Xu et al. | Model predictive control for lane keeping system in autonomous vehicle | |
CN111547066A (zh) | 车辆轨迹跟踪方法、装置、设备及存储介质 | |
CN111016891A (zh) | 一种车辆行驶的路线跟踪控制方法及装置 | |
CN206657243U (zh) | 磁条导航的单驱单向自动导引运输车纠偏控制系统 | |
JP7167977B2 (ja) | 車両走行支援方法及び車両走行支援装置 | |
CN115047766A (zh) | 一种基于预测控制模型的速度规划方法 | |
CN108508899A (zh) | 一种无人驾驶车辆轨迹跟踪控制行驶系统 | |
CN112731932B (zh) | 一种移动机器人的路径跟踪方法 | |
JP2008059366A (ja) | 操舵角決定装置、自動車及び操舵角決定方法 | |
Feraco et al. | Combined lane keeping and longitudinal speed control for autonomous driving | |
CN103269894A (zh) | 反作用力控制装置 | |
CN111661048B (zh) | 多铰接式车辆及其轨迹跟随控制方法与系统 | |
CN110703775A (zh) | 一种基于改进人工势场的商用车车道保持路径规划方法 | |
CN109556623A (zh) | 融合触须算法与切线图法的迭代式路径规划算法 | |
CN111609866B (zh) | 基于差分gps的园区车辆智能驾驶路径拟合跟踪控制方法 |
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 |