CN116257069B - 一种无人车辆编队决策与速度规划的方法 - Google Patents
一种无人车辆编队决策与速度规划的方法 Download PDFInfo
- Publication number
- CN116257069B CN116257069B CN202310547407.5A CN202310547407A CN116257069B CN 116257069 B CN116257069 B CN 116257069B CN 202310547407 A CN202310547407 A CN 202310547407A CN 116257069 B CN116257069 B CN 116257069B
- Authority
- CN
- China
- Prior art keywords
- speed
- vehicle
- formation
- calculating
- distance
- 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 34
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 33
- 230000001133 acceleration Effects 0.000 claims abstract description 5
- 238000004891 communication Methods 0.000 abstract description 7
- 230000006399 behavior Effects 0.000 description 7
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000002457 bidirectional effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 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/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of 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)
Abstract
本发明提供一种无人车辆编队决策与速度规划的方法,包括如下步骤:S1、将参与编队的每台车辆都设置为编队形式状态;S2、计算当前车辆与前车实际距离;S3、计算指定跟车距离与实际距离的差;S4、计算达到指定跟车距离所需要变化的速度;S5、计算车辆的期望速度,S6、计算下发速度对编队车辆加减速控制。本发明解决了多辆无人车之间没有进行通讯的同时依旧能够进行编队行驶的问题,通过本方法得到的最终速度考虑了车辆当前速度,使得车辆的速度变化平缓,提高了车辆使用舒适度。
Description
技术领域
本发明主要涉及自动驾驶相关技术领域,具体是一种无人车辆编队决策与速度规划的方法。
背景技术
编队控制问题是多无人车系统协调控制中的一类基本问题。在一些特殊的任务和环境中,无人车需要在一定的约束条件下达到和保持一定的几何结构,灵活、快速地适应环境,进而在复杂环境中高效、可靠地执行任务,目前主要的编队方式为行为法、虚拟结构法等。
行为法是基于多无人车系统的底层运动控制,上层决策系统对多无人车的行为进行设计,并通过这些基本行为进行组合来实现编队控制,其优点是不管环境多么复杂,都能够快速得出控制结论。该方法的另一个优点是可以实现分布式控制。其缺点是在多种行为中难以选择较为容易进行建模的行为。另外在融合各个行为时不确定是否存在不相融的情况,行为越多,环境越复杂,融合后的方法就越难满足各个条件。
虚拟结构法是将无人车团体的队形看作是一个刚体的虚拟结构,每个无人车是虚拟结构上相对固定的一点。通过双向控制了解每一个无人车的位置,通过各个层面的轨迹再把其方向和位置进行细微的调整。之后跟每一个固定的点匹配,并循环得到结果。这类方法的优点是跟踪轨迹的精度高易于观察;每一个功能之间的界限不明确,不用设计高难度的通信。其缺点是队形单一难以运用到更多的领域。
在目前的实际情况中,两辆无人车之间如果没有第三方的介入(如相互之间不进行通讯),那么车辆的速度会产生忽快忽慢的情况,速度变化不平缓,极大的影响了无人车的使用。
发明内容
为解决目前技术的不足,本发明结合现有技术,从实际应用出发,提供一种无人车辆编队决策与速度规划的方法,解决了多辆无人车之间没有进行通讯的同时依旧能够进行编队行驶的问题,通过本方法得到的最终速度考虑了车辆当前速度,使得车辆的速度变化平缓,提高了车辆使用舒适度。
本发明的技术方案如下:
一种无人车辆编队决策与速度规划的方法,包括如下步骤:
S1、将参与编队的每台车辆都设置为编队行驶状态;
S2、计算当前车辆与前车实际距离;
S3、计算指定跟车距离与实际距离/>的差/>;
S4、计算达到指定跟车距离所需要变化的速度;
S5、计算车辆的期望速度,公式如下:
上式中,为车辆设定的最大速度,/>为设定的最大距离,为设定的急停距离;
S6、计算下发速度对编队车辆加减速控制,公式如下:
上式中,为设定的跟车时加速度单次最大的增大量,/>,为当前实际车速。
进一步,步骤S2中,当前车辆与前车实际距离 为轨迹上k个点欧式距离的和,计算公式如下:
上式中,为轨迹的第n个点; />为轨迹的第(n-1)个点;/>为点在坐标系x轴上对应的值; y为点在坐标系y轴上对应的值。
进一步,步骤S4中,引入参数1用于控制车辆达到目标跟车距离的时间快慢,达到指定跟车距离所需要变化的速度/>计算公式如下:
。
进一步,参数1值越大表示所需时间越短,值越小表示所需时间越大,采用人为赋值,取值范围为(0,∞)。
进一步,步骤S5中,为人工赋值,取值范围为(0,∞),/>为人工赋值,取值范围为(/>_dis,∞),/>为人工赋值,取值范围为(0,∞),/>为人工赋值,取值范围为(/>_dis, ∞)。
进一步,步骤S6中,引入参数,参数/>为车辆最大速度,基于参数/>对下发速度/>进一步限定,公式如下:
。
进一步,步骤S6中,为人工赋值,取值范围为(0,∞),/>为人工赋值,取值范围为[/>,∞)。
本发明的有益效果:
本发明能够使得多辆无人车之间在没有进行通讯的同时依旧能够按照需求进行编队行驶,本发明的速度规划充分考虑了各因素的影响,通过引入多个参数得到当前的速度与前车实际距离()对应的曲线方程,从而得到去期望速度,再基于期望速度以及当前实际速度对车辆下发速度进行控制,通过本方法得到的最终速度,使得车辆的速度变化平缓,提高了舒适度,避免了车辆速度会产生忽快忽慢的情况。
附图说明
图1为本发明的流程图。
具体实施方式
结合附图和具体实施例,对本发明作进一步说明。应理解,这些实施例仅用于说明本发明而不用于限制本发明的范围。此外应理解,在阅读了本发明讲授的内容之后,本领域技术人员可以对本发明作各种改动或修改,这些等价形式同样落于本申请所限定的范围。
本实施例提供一种车辆编队决策与速度规划的方法,主要用于解决在多辆无人车之间没有进行通讯时的编队问题,可保证无人车辆速度平缓的变化,从而提高使用体验及舒适度。
如图所示,本实施例的车辆编队决策与速度规划的方法主要包括如下步骤。
S1、车辆设置编队模式,将参与编队的每台车辆都设置为编队行驶状态。
S2、计算当前车辆与前车实际距离,实际距离为轨迹上k个点欧式距离的和,采用公式如下:
。
上述,为轨迹的第n个点; />为轨迹的第(n-1)个点;/>为点在坐标系x轴上对应的值; y为点在坐标系y轴上对应的值。
S3、计算指定跟车距离与实际距离/>的差/>,公式如下:
。
S4、引入参数1,控制车辆达到目标跟车距离的时间快慢,计算达到指定跟车距离所需要变化的速度,公式如下:
。
S5、得到当前的速度与前车实际距离对应的曲线方程,引入参数_dis,/>_dis需要大于0,意义为急停距离; 引入参数Max_dis,当前车实际距离大于等于Max_dis时,当前车辆期望车速需要达到设定的最大车速;车辆的期望速度/>取决于到前车的一个实际距离/>和几个阈值距离的关系,当/>小于时,当前车辆与前车的距离太近,过于危险,所以需要停车,即/>等于0;当大于/>小于Max_dis时,/>随/>变化而变化,当大于Max_dis,/>取最大速度,公式如下:
。
S6、参考当前实际车速进行车辆的加减速控制,引入参数/>,/>取值大于0表示跟车时加速度单次最大的增大量,/>为/>与/>的差的;当/>小于等于0时,下发速度/>等于0;当/>大于0且小于等于/>时,下发速度/>等于加/>;当/>大于/>时,下发速度/>等于/>加/>;公式如下:
。
同时,考虑到行车安全,引入参数,意义为车辆最大速度,当/>小于时,/>不变;当/>大于/>时,/>等于/>,公式如下:
。
在本实施例中,各参数意义以及取值具体参考表1.
表1参数取值参考
本实施例所提供的无人车辆编队与速度规划的方法,解决了多辆无人车之间没有进行通讯的同时依旧能够进行编队行驶的问题,通过本方法对应方程得到的最终速度考虑了车辆当前速度,使得车辆的速度变化平缓,提高了舒适度。
Claims (7)
1.一种无人车辆编队决策与速度规划的方法,其特征在于,包括如下步骤:
S1、将参与编队的每台车辆都设置为编队行驶状态;
S2、计算当前车辆与前车实际距离;
S3、计算指定跟车距离与实际距离/>的差/>;
S4、计算达到指定跟车距离所需要变化的速度;
S5、计算车辆的期望速度,公式如下:
;
上式中,为车辆设定的最大速度,/>为设定的最大距离,/>为设定的急停距离;
S6、计算下发速度对编队车辆加减速控制,公式如下:
;
上式中,为设定的跟车时加速度单次最大的增大量,/>,为当前实际车速。
2.根据权利要求1所述的无人车辆编队决策与速度规划的方法,其特征在于,步骤S2中,当前车辆与前车实际距离 为轨迹上k个点欧式距离的和,计算公式如下:
;
上式中,为轨迹的第n个点; />为轨迹的第(n-1)个点;/>为点在坐标系x轴上对应的值; y为点在坐标系y轴上对应的值。
3.根据权利要求1所述的无人车辆编队决策与速度规划的方法,其特征在于,步骤S4中,引入参数1用于控制车辆达到目标跟车距离的时间快慢,达到指定跟车距离所需要变化的速度/>计算公式如下:
。
4.根据权利要求3所述的无人车辆编队决策与速度规划的方法,其特征在于,参数1值越大表示所需时间越短,值越小表示所需时间越大,采用人为赋值,取值范围为(0,∞)。
5.根据权利要求1所述的无人车辆编队决策与速度规划的方法,其特征在于,步骤S5中,为人工赋值,取值范围为(0,∞),/>为人工赋值,取值范围为(/>_dis,∞),/>为人工赋值,取值范围为(0,∞),/>为人工赋值,取值范围为(/>_dis, ∞)。
6.根据权利要求1所述的无人车辆编队决策与速度规划的方法,其特征在于,步骤S6中,引入参数,参数/>为车辆最大速度,基于参数/>对下发速度/>进一步限定,公式如下:
。
7.根据权利要求6所述的无人车辆编队决策与速度规划的方法,其特征在于,步骤S6中,为人工赋值,取值范围为(0,∞),/>为人工赋值,取值范围为[/>,∞)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310547407.5A CN116257069B (zh) | 2023-05-16 | 2023-05-16 | 一种无人车辆编队决策与速度规划的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310547407.5A CN116257069B (zh) | 2023-05-16 | 2023-05-16 | 一种无人车辆编队决策与速度规划的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116257069A CN116257069A (zh) | 2023-06-13 |
CN116257069B true CN116257069B (zh) | 2023-08-08 |
Family
ID=86684760
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310547407.5A Active CN116257069B (zh) | 2023-05-16 | 2023-05-16 | 一种无人车辆编队决策与速度规划的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116257069B (zh) |
Citations (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR464049A (fr) * | 1913-09-05 | 1914-03-11 | Arthur Hungerford Pollen | Système d'horloge indicatrice de distances |
US4896090A (en) * | 1988-10-31 | 1990-01-23 | General Electric Company | Locomotive wheelslip control system |
US5839534A (en) * | 1995-03-01 | 1998-11-24 | Eaton Vorad Technologies, Llc | System and method for intelligent cruise control using standard engine control modes |
US5871062A (en) * | 1995-04-13 | 1999-02-16 | Mercedes-Benz Ag | Method and device for speed and distance control for a motor vehicle |
US6292737B1 (en) * | 1999-05-25 | 2001-09-18 | Nissan Motor Co., Ltd. | Preceding vehicle follow-up control system |
CN1522427A (zh) * | 2001-06-30 | 2004-08-18 | �ʼҷ����ֵ�������˾ | 智能停车顾问器 |
DE10311191A1 (de) * | 2003-03-12 | 2004-09-23 | Robert Bosch Gmbh | Verfahren und Vorrichtung zur Geschwindigkeitsregelung eines Kraftfahrzeugs |
EP1967821A1 (de) * | 2007-03-09 | 2008-09-10 | Wolfgang Dr. Sassin | Assistenzsystem für den Fahrer eines Fahrzeugs, insbesondere eines Kraftfahrzeugs für den öffentlichen Strassenverkehr |
JP2009248683A (ja) * | 2008-04-03 | 2009-10-29 | Toyota Motor Corp | 車間距離制御装置 |
CN105579320A (zh) * | 2013-09-05 | 2016-05-11 | 李斯特内燃机及测试设备公司 | 一种用于优化驾驶员辅助系统的方法和设备 |
CN107221182A (zh) * | 2016-03-21 | 2017-09-29 | 中国移动通信集团广东有限公司 | 车辆终端在车联网中附着的方法、道路分段设备、车辆终端 |
WO2018000386A1 (zh) * | 2016-06-30 | 2018-01-04 | 华为技术有限公司 | 控制车辆编队行驶的方法、集中控制设备和车辆 |
CN110687776A (zh) * | 2019-10-30 | 2020-01-14 | 武汉理工大学 | 一种多船同步过闸自适应巡航编队控制系统及方法 |
CN110930766A (zh) * | 2019-12-02 | 2020-03-27 | 武汉理工大学 | 一种基于图论与势场方法的无人车多车道护航编队方法 |
CN113335277A (zh) * | 2021-04-27 | 2021-09-03 | 北京工业大学 | 智能巡航控制方法、装置、电子设备和存储介质 |
CN114003024A (zh) * | 2020-07-13 | 2022-02-01 | 广州汽车集团股份有限公司 | 一种基于车辆编队的跟随车车速规划方法、装置及汽车 |
WO2022063331A1 (zh) * | 2020-09-25 | 2022-03-31 | 金龙联合汽车工业(苏州)有限公司 | 一种基于v2x的编队行驶智能网联客车 |
CN114644017A (zh) * | 2022-05-06 | 2022-06-21 | 重庆大学 | 一种实现自动驾驶车辆安全决策控制的方法 |
CN115320589A (zh) * | 2022-10-13 | 2022-11-11 | 青岛慧拓智能机器有限公司 | 跟车速度规划方法、装置、芯片、终端、电子设备及介质 |
CN116069037A (zh) * | 2023-01-31 | 2023-05-05 | 新石器慧通(北京)科技有限公司 | 无人车编队轨迹规划控制方法、装置、设备及存储介质 |
CN116088520A (zh) * | 2023-02-07 | 2023-05-09 | 睿羿科技(山东)有限公司 | 一种无人驾驶铰链车辆的精准方向控制方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040068415A1 (en) * | 2002-04-22 | 2004-04-08 | Neal Solomon | System, methods and apparatus for coordination of and targeting for mobile robotic vehicles |
US7860639B2 (en) * | 2003-02-27 | 2010-12-28 | Shaoping Yang | Road traffic control method and traffic facilities |
AU2010213757B2 (en) * | 2009-02-12 | 2015-07-02 | Ansaldo Sts Usa, Inc. | System and method for controlling braking of a train |
DE102017205488A1 (de) * | 2017-03-31 | 2018-10-04 | Robert Bosch Gmbh | Verfahren zur automatischen Einstellung der Fahrzeuggeschwindigkeit |
EP3842304B1 (en) * | 2018-08-14 | 2024-09-18 | Mobileye Vision Technologies Ltd. | Systems and methods for navigating with safe distances |
CN113439048A (zh) * | 2019-02-14 | 2021-09-24 | 三菱电机株式会社 | 车间距离控制装置 |
-
2023
- 2023-05-16 CN CN202310547407.5A patent/CN116257069B/zh active Active
Patent Citations (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR464049A (fr) * | 1913-09-05 | 1914-03-11 | Arthur Hungerford Pollen | Système d'horloge indicatrice de distances |
US4896090A (en) * | 1988-10-31 | 1990-01-23 | General Electric Company | Locomotive wheelslip control system |
US5839534A (en) * | 1995-03-01 | 1998-11-24 | Eaton Vorad Technologies, Llc | System and method for intelligent cruise control using standard engine control modes |
US5871062A (en) * | 1995-04-13 | 1999-02-16 | Mercedes-Benz Ag | Method and device for speed and distance control for a motor vehicle |
US6292737B1 (en) * | 1999-05-25 | 2001-09-18 | Nissan Motor Co., Ltd. | Preceding vehicle follow-up control system |
CN1522427A (zh) * | 2001-06-30 | 2004-08-18 | �ʼҷ����ֵ�������˾ | 智能停车顾问器 |
DE10311191A1 (de) * | 2003-03-12 | 2004-09-23 | Robert Bosch Gmbh | Verfahren und Vorrichtung zur Geschwindigkeitsregelung eines Kraftfahrzeugs |
EP1967821A1 (de) * | 2007-03-09 | 2008-09-10 | Wolfgang Dr. Sassin | Assistenzsystem für den Fahrer eines Fahrzeugs, insbesondere eines Kraftfahrzeugs für den öffentlichen Strassenverkehr |
JP2009248683A (ja) * | 2008-04-03 | 2009-10-29 | Toyota Motor Corp | 車間距離制御装置 |
CN105579320A (zh) * | 2013-09-05 | 2016-05-11 | 李斯特内燃机及测试设备公司 | 一种用于优化驾驶员辅助系统的方法和设备 |
CN107221182A (zh) * | 2016-03-21 | 2017-09-29 | 中国移动通信集团广东有限公司 | 车辆终端在车联网中附着的方法、道路分段设备、车辆终端 |
WO2018000386A1 (zh) * | 2016-06-30 | 2018-01-04 | 华为技术有限公司 | 控制车辆编队行驶的方法、集中控制设备和车辆 |
CN110687776A (zh) * | 2019-10-30 | 2020-01-14 | 武汉理工大学 | 一种多船同步过闸自适应巡航编队控制系统及方法 |
CN110930766A (zh) * | 2019-12-02 | 2020-03-27 | 武汉理工大学 | 一种基于图论与势场方法的无人车多车道护航编队方法 |
CN114003024A (zh) * | 2020-07-13 | 2022-02-01 | 广州汽车集团股份有限公司 | 一种基于车辆编队的跟随车车速规划方法、装置及汽车 |
WO2022063331A1 (zh) * | 2020-09-25 | 2022-03-31 | 金龙联合汽车工业(苏州)有限公司 | 一种基于v2x的编队行驶智能网联客车 |
CN113335277A (zh) * | 2021-04-27 | 2021-09-03 | 北京工业大学 | 智能巡航控制方法、装置、电子设备和存储介质 |
CN114644017A (zh) * | 2022-05-06 | 2022-06-21 | 重庆大学 | 一种实现自动驾驶车辆安全决策控制的方法 |
CN115320589A (zh) * | 2022-10-13 | 2022-11-11 | 青岛慧拓智能机器有限公司 | 跟车速度规划方法、装置、芯片、终端、电子设备及介质 |
CN116069037A (zh) * | 2023-01-31 | 2023-05-05 | 新石器慧通(北京)科技有限公司 | 无人车编队轨迹规划控制方法、装置、设备及存储介质 |
CN116088520A (zh) * | 2023-02-07 | 2023-05-09 | 睿羿科技(山东)有限公司 | 一种无人驾驶铰链车辆的精准方向控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN116257069A (zh) | 2023-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11584343B2 (en) | Method and system for control of motor vehicle longitudinal movement | |
CN105730279B (zh) | 一种电动汽车的超速控制方法和系统 | |
CN110286681B (zh) | 一种变曲率弯道的动态自动驾驶换道轨迹规划方法 | |
CN108569287B (zh) | 生成车辆控制命令的方法和装置、车辆控制器、存储介质 | |
CN104670235B (zh) | 一种前车跟随的实现方法 | |
CN109229098A (zh) | 一种用于控制车辆自适应巡航车距的方法及车用跟随行驶控制装置 | |
CN107487324A (zh) | 控制电动汽车转矩的方法和装置 | |
CN112965501A (zh) | 一种自动驾驶速度规划方法及装置 | |
CN108153246B (zh) | 一种基于指定速度的参数自适应s形速度规划插补方法 | |
CN109765887A (zh) | 一种自动驾驶控制方法 | |
JP2019034591A (ja) | 車両運動制御装置及びその方法、並びに、目標軌道生成装置及びその方法 | |
CN109032128B (zh) | 离散多agv非质点系统的三角编队控制方法 | |
CN111739342A (zh) | 用于避让侧前方车辆的方法、装置、介质以及车辆 | |
CN110893850A (zh) | 一种车辆纵向速度规划方法和纵向速度规划装置 | |
CN108609009A (zh) | 使用车辆行驶信息控制车辆减速的方法 | |
JP2017088161A (ja) | ラウンドアバウトで自動車の前後方向コントロール装置を作動させる方法 | |
CN116257069B (zh) | 一种无人车辆编队决策与速度规划的方法 | |
CN115903854B (zh) | 一种动态结构化道路的自动驾驶实时轨迹规划方法 | |
CN113613978B (zh) | 用于操作车辆的车载控制系统 | |
CN108279644B (zh) | 基于叠加指令的直线插补控制方法 | |
CN116300866A (zh) | 基于人工势场法的车辆避障方法、设备及介质 | |
CN113715820B (zh) | 一种基于速度补偿pid的车辆速度控制方法及装置 | |
CN115534930A (zh) | 车辆横向控制方法、装置和电子设备 | |
JP2018039435A (ja) | 車間距離制御方法と車間距離制御装置 | |
CN112498355A (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 |