CN114524020A - 一种车辆人机共驾的方向盘角度控制方法 - Google Patents
一种车辆人机共驾的方向盘角度控制方法 Download PDFInfo
- Publication number
- CN114524020A CN114524020A CN202210188423.5A CN202210188423A CN114524020A CN 114524020 A CN114524020 A CN 114524020A CN 202210188423 A CN202210188423 A CN 202210188423A CN 114524020 A CN114524020 A CN 114524020A
- Authority
- CN
- China
- Prior art keywords
- steering wheel
- angle
- wheel angle
- time
- vehicle
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/021—Determination of steering angle
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明公开了一种车辆人机共驾的方向盘角度控制方法,包括以下步骤:1)获取目标车辆的横向控制信息;2)根据所述目标车辆的横向控制信息计算目标车辆的方向盘角度信号误差;3)通过插值计算得到方向盘角度误差修正角度;4)输出修正后的方向盘控制角度信息,对目标车辆的方向盘角度进行控制。本发明在横向功能开启或关闭时,采用实际方向盘角度与期望方向盘角度以五次多项式样条曲线平滑过渡的方法,用于解决驾驶员在开启或关闭横向功能时出现方向盘猛打的情况,影响行车安全,带给驾驶员和乘客不良的乘坐体验的技术问题。
Description
技术领域
本发明涉及自动驾驶技术领域,具体涉及一种车辆人机共驾的方向盘角度控制方法。
背景技术
随着人工智能技术的蓬勃发展,自动驾驶技术逐渐受到更高的关注,搭载自动驾驶功能的车辆也受到人们的青睐。自动驾驶的横向控制是实现全自动驾驶的关键步骤之一,横向控制主要是对车辆的行驶方向进行控制,保证车辆行驶在车道线的中央区域。当横向控制功能开启时,自动驾驶车辆在人机控制进行切换的时候,此时并不能保证车辆一定处于中央领域。为了尽快回到中央区域,会出现猛打方向盘的情况,造成车辆在行驶过程中不稳定,影响行车安全。
在公开号为CN108803322A的发明专利申请中公开了一种时域变权重的驾驶员-自动驾驶系统柔性接管方法,该方法所采用的是通过模糊评价指标判断危险程度,然后通过时域中权重的改变,使驾驶员的意图逐渐转移到自动驾驶控制器意图上,实现驾驶权的平滑过渡,但是模糊控制规则和隶属度函数的获取与确定仍存在瓶颈与问题,因此急需一种简单明确且高效的方法实现驾驶权的平滑过渡。
发明内容
针对现有技术存在的上述不足,本发明要解决的技术问题是:如何提供一种简单明确且高效的方法来实现驾驶权平滑过渡的车辆人机共驾的方向盘角度控制方法。
为了解决上述技术问题,本发明采用如下技术方案:
一种车辆人机共驾的方向盘角度控制方法,包括以下步骤:
步骤1)获取目标车辆的横向控制信息;
步骤2)根据所述目标车辆的横向控制信息计算目标车辆的方向盘角度信号误差;
步骤3)通过插值计算得到方向盘角度误差修正角度;
步骤4)输出修正后的方向盘控制角度信息,对目标车辆的方向盘角度进行控制。
优选的,步骤1)中,所述目标车辆的横向控制信息包括横向控制功能开启信号、实际方向盘角度信号和期望方向盘角度信号,并记录横向功能开启时刻的上升沿信号。
优选的,步骤2)中,利用目标车辆的实际方向盘角度信号和计算得到的期望方向盘角度信号,计算起始时刻实际方向盘角度与期望方向盘角度之间的角度信号误差。
优选的,步骤3)中,利用五次多项式插值计算在规定时间内由实际方向盘角度平滑过渡修正到期望方向盘角度的方向盘角度误差修正角度。
优选的,步骤4)中,以步骤3)中得到的方向盘角度误差修正角度作为修正后的方向盘控制角度信息进行输出。
优选的,步骤3)中,五次多项式的曲线方程为:
q(t)=a0+a1*(t-t0)+a2*(t-t0)2+a3*(t-t0)3+a4*(t-t0)4+a5*(t-t0)5; (1)
式中:q1(t)为方向盘在t时刻的角度;
t0为起始时刻;
a0、a1、a2、a3、a4、a5为系数。
优选的,设定起点时刻t0方向盘的角度q(t0)、速度v0和加速度a0分别为:
设定终点时刻t1方向盘的角度q(t1)、速度v1和加速度a1分别为:
则根据公式(1)、(2)、(3)可以得到:
a0=q0
al=v0
式中:T=t1-t0;h=q1-q0。
优选的,设定q0=0;a0=0;v0=0;a1=0;v1=0;则结合公式(1)到(4),可得到以下公式:
式中,ti为当前插值时刻,q(ti)为当前时刻与起始时刻方向盘的角度增量。
优选的,步骤3)在插值过程中,加入当前时刻ti和起始时刻t0的期望方向盘角度差值SW,且SW的计算公式为:
式中,SWi是当前时刻ti的期望方向盘角度,SW0是起始时刻t0的期望方向盘角度。
优选的,步骤4)中,校核插值时间判断目标车辆是否处于插值过程中,若插值时间小于规定时间,则将步骤3)得到的方向盘角度误差修正角度作为修正后的方向盘控制角度信息进行输出;若插值时间大于等于规定时间,则不进行插值,直接将期望方向盘角度作为修正后的方向盘控制角度信息进行输出。
与现有技术相比,本发明具有以下优点:
1、本发明在横向功能开启或关闭时,采用实际方向盘角度与期望方向盘角度以五次多项式样条曲线平滑过渡的方法,用于解决驾驶员在开启或关闭横向功能时出现方向盘猛打的情况,影响行车安全,带给驾驶员和乘客不良的乘坐体验的技术问题。
2、本发明对于具有n个数据点的情况,可以对所有相邻的2个点应用上述五次多项式的公式,最终得到的插值曲线无论是位置、速度还是加速度三条曲线都是连续的,并且位置和速度还是平滑的。
3、本发明的五次多项式插值拥有轨迹平滑、运动稳定等诸多优点,足以应付大部分的场景,但是它在插值过程中往往伴随着计算量大的缺点,为了优化域控制器的内存,减小运算量,本发明进一步采用增量式的五次多项式插值来简便运算过程。
4、本发明在插值过程中,加入当前时刻和起始时刻的期望方向盘转角差值,使得插值过程是连续的,输出的当前时刻和起始时刻的期望方向盘转角差值也是连续的,在规定时间内由五次多项式输出的插值结果也是光滑连续的,不会出现突变的情况。
附图说明
图1为本发明车辆人机共驾的方向盘角度控制方法的流程图。
具体实施方式
下面将结合附图及实施例对本发明作进一步说明。
如附图1所示,一种车辆人机共驾的方向盘角度控制方法,包括以下步骤:
步骤1)获取目标车辆的横向控制信息。目标车辆的横向控制信息包括横向控制功能开启信号、实际方向盘角度信号和期望方向盘角度信号,并记录横向功能开启时刻的上升沿信号,本方法仅在功能刚开启或关闭时刻起作用。
步骤2)根据所述目标车辆的横向控制信息计算目标车辆的方向盘角度信号误差。利用目标车辆的实际方向盘角度信号和计算得到的期望方向盘角度信号,计算起始时刻实际方向盘角度与期望方向盘角度之间的角度信号误差,并将当前的角度误差记录下来在插值过程中使用。
步骤3)通过插值计算得到方向盘角度误差修正角度。利用五次多项式插值计算在规定时间内由实际方向盘角度平滑过渡修正到期望方向盘角度的方向盘角度误差修正角度。
步骤4)输出修正后的方向盘控制角度信息,对目标车辆的方向盘角度进行控制。以步骤3)中得到的方向盘角度误差修正角度作为修正后的方向盘控制角度信息进行输出。
在本实施例中,当横向功能开启或关闭时,在规定时间内进行五次多项式插值,以输出一个连续平缓的方向盘角度信号;若超出规定时间则直接采用期望方向盘角度信号控制目标车辆居中行驶。
在本实施例中,当检测到横向功能开启且触发上升沿时,开始计算插值时间。从0开始每次增加一个周期时间,直至叠加至规定时间为止,若运行过程中未叠加至规定时间时横向功能已退出,则退出插值时间计算,等待下次激活。
在本实施例中,五次多项式的曲线方程为:
q(t)=a0+a1*(t-t0)+a2*(t-t0)2+a3*(t-t0)3+a4*(t-t0)4+a5*(t-t0)5; (1)
式中:q(t)为方向盘在t时刻的角度;
t0为起始时刻;
a0、a1、a2、a3、a4、a5为系数。
在本实施例中,设定起点时刻t0方向盘的角度q(t0)、速度v0和加速度a0分别为:
设定终点时刻t1方向盘的角度q(t1)、速度v1和加速度a1分别为:
则根据公式(1)、(2)、(3)可以得到:
a0=q0
01=v0
式中:T=t1-t0;h=q1-q10。
在本实施例中,五次多项式插值拥有轨迹平滑、运动稳定等诸多优点,足以应付大部分的场景,但是它在插值过程中往往伴随着计算量大的缺点。在算力并不充足的汽车域控制器上,使用五次多项式插值会耗费较大的内存空间,为了优化域控制器的内存,减小运算量,故采用一种增量式的五次多项式插值来简便运算过程。
在增量式的五次多项式插值过程中,设定q0=0;a0=0;v0=0;a1=0;v1=0;则结合公式(1)到(4),可得到以下公式:
式中,ti为当前插值时刻,q(ti)为当前时刻与起始时刻方向盘的角度增量。
同时,在目标车辆行驶时,汽车的期望方向盘角度和实际方向盘角度实时更新,则h值也是实时更新的,这样计算出来的插值结果并不能保证在整个插值过程中一定是连续平滑的。为了保证输出结果的连续性和平滑性,在插值过程中一直使用起始时刻的角度误差值,即维持h值不变,则插值过程中角度增量q(ti)才是按照五次多项式平滑增长的。
在本实施例中,由于目标车辆的期望方向盘角度是时刻变化的,不能一直使用起始时刻的期望方向盘角度来控制目标车辆,否则插值结束时方向盘角度会有一个突变,给车辆用户不良的驾驶体验。为了弥补当前时刻与起始时刻的期望方向盘角度误差,引入当前时刻的期望方向盘转角来解决插值结束后的角度突变问题,加入当前时刻ti和起始时刻t0的期望方向盘角度差值SW,且SW的计算公式为:
式中,SWi是当前时刻ti的期望方向盘角度;SW0是起始时刻t0的期望方向盘角度。
这样,在插值过程中,加入当前时刻和起始时刻的期望方向盘角度差值。插值过程是连续的,输出的当前时刻和起始时刻的期望方向盘转角差值也是连续的,在规定时间内由五次多项式输出的插值结果也是光滑连续的,不会出现突变的情况。
在本实施例中,步骤4)中,校核插值时间判断目标车辆是否处于插值过程中,若插值时间小于规定时间,则将步骤3)得到的方向盘角度误差修正角度作为修正后的方向盘控制角度信息进行输出;若插值时间大于等于规定时间,则不进行插值,直接将期望方向盘角度作为修正后的方向盘控制角度信息进行输出。
与现有技术相比,本发明在横向功能开启或关闭时,采用实际方向盘角度与期望方向盘角度以五次多项式样条曲线平滑过渡的方法,用于解决驾驶员在开启或关闭横向功能时出现方向盘猛打的情况,影响行车安全,带给驾驶员和乘客不良的乘坐体验的技术问题。本发明对于具有n个数据点的情况,可以对所有相邻的2个点应用上述五次多项式的公式,最终得到的插值曲线无论是位置、速度还是加速度三条曲线都是连续的,并且位置和速度还是平滑的。
最后需要说明的是,以上实施例仅用以说明本发明的技术方案而非限制技术方案,本领域的普通技术人员应当理解,那些对本发明的技术方案进行修改或者等同替换,而不脱离本技术方案的宗旨和范围,均应涵盖在本发明的权利要求范围当中。
Claims (10)
1.一种车辆人机共驾的方向盘角度控制方法,其特征在于,包括以下步骤:
步骤1)获取目标车辆的横向控制信息;
步骤2)根据所述目标车辆的横向控制信息计算目标车辆的方向盘角度信号误差;
步骤3)通过插值计算得到方向盘角度误差修正角度;
步骤4)输出修正后的方向盘控制角度信息,对目标车辆的方向盘角度进行控制。
2.根据权利要求1所述的车辆人机共驾的方向盘角度控制方法,其特征在于,步骤1)中,所述目标车辆的横向控制信息包括横向控制功能开启信号、实际方向盘角度信号和期望方向盘角度信号,并记录横向功能开启时刻的上升沿信号。
3.根据权利要求2所述的车辆人机共驾的方向盘角度控制方法,其特征在于,步骤2)中,利用目标车辆的实际方向盘角度信号和计算得到的期望方向盘角度信号,计算起始时刻实际方向盘角度与期望方向盘角度之间的角度信号误差。
4.根据权利要求3所述的车辆人机共驾的方向盘角度控制方法,其特征在于,步骤3)中,利用五次多项式插值计算在规定时间内由实际方向盘角度平滑过渡修正到期望方向盘角度的方向盘角度误差修正角度。
5.根据权利要求4所述的车辆人机共驾的方向盘角度控制方法,其特征在于,步骤4)中,以步骤3)中得到的方向盘角度误差修正角度作为修正后的方向盘控制角度信息进行输出。
6.根据权利要求5所述的车辆人机共驾的方向盘角度控制方法,其特征在于,步骤3)中,五次多项式的曲线方程为:
q(t)=a0+a1*(t-t0)+a2*(t-t0)2+a3*(t-t0)3+a4*(t-t0)4+a5*(t-t0)5; (1)
式中:q(t)为方向盘在t时刻的角度;
t0为起始时刻;
a0、a1、a2、a3、a4、a5为系数。
10.根据权利要求9所述的车辆人机共驾的方向盘角度控制方法,其特征在于,步骤4)中,校核插值时间判断目标车辆是否处于插值过程中,若插值时间小于规定时间,则将步骤3)得到的方向盘角度误差修正角度作为修正后的方向盘控制角度信息进行输出;若插值时间大于等于规定时间,则不进行插值,直接将期望方向盘角度作为修正后的方向盘控制角度信息进行输出。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210188423.5A CN114524020B (zh) | 2022-02-28 | 2022-02-28 | 一种车辆人机共驾的方向盘角度控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210188423.5A CN114524020B (zh) | 2022-02-28 | 2022-02-28 | 一种车辆人机共驾的方向盘角度控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114524020A true CN114524020A (zh) | 2022-05-24 |
CN114524020B CN114524020B (zh) | 2023-09-01 |
Family
ID=81624852
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210188423.5A Active CN114524020B (zh) | 2022-02-28 | 2022-02-28 | 一种车辆人机共驾的方向盘角度控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114524020B (zh) |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6282472B1 (en) * | 1998-04-01 | 2001-08-28 | Trw Lucasvarity Electric Steering Ltd. | Electric power steering system with boost curve having portions defined by polynomial equations |
CN107848526A (zh) * | 2016-05-25 | 2018-03-27 | Ntn株式会社 | 车辆转弯控制装置 |
JP2019043395A (ja) * | 2017-09-04 | 2019-03-22 | 日産自動車株式会社 | 運転支援車両の走行制御方法及び走行制御装置 |
CN109844669A (zh) * | 2016-09-29 | 2019-06-04 | 本田技研工业株式会社 | 车辆控制装置 |
CN110949370A (zh) * | 2019-03-18 | 2020-04-03 | 长城汽车股份有限公司 | 自动驾驶车辆的安全监测方法、系统及运动控制系统 |
CN112208515A (zh) * | 2020-10-19 | 2021-01-12 | 一汽解放汽车有限公司 | 一种车辆横向控制方法、装置、设备及介质 |
CN113276833A (zh) * | 2021-05-11 | 2021-08-20 | 上汽通用五菱汽车股份有限公司 | 车辆的横向运动控制方法、控制终端及存储介质 |
CN113386795A (zh) * | 2021-07-05 | 2021-09-14 | 西安电子科技大学芜湖研究院 | 一种自动驾驶车辆智能决策及局部轨迹规划方法及其决策系统 |
CN113581288A (zh) * | 2021-09-01 | 2021-11-02 | 国汽智控(北京)科技有限公司 | 自动驾驶横向偏移动态修正方法、装置、设备及存储介质 |
CN113650609A (zh) * | 2021-09-28 | 2021-11-16 | 中国科学技术大学先进技术研究院 | 基于模糊规则的人机共驾控制权柔性转移方法及系统 |
WO2021228657A1 (fr) * | 2020-05-12 | 2021-11-18 | Renault S.A.S | Module de contrôle de trajectoire, dispositif de contrôle de trajectoire et procédé associés |
CN113734279A (zh) * | 2021-09-22 | 2021-12-03 | 重庆长安汽车股份有限公司 | 方向盘角度偏差自动修正方法、系统、车辆及存储介质 |
-
2022
- 2022-02-28 CN CN202210188423.5A patent/CN114524020B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6282472B1 (en) * | 1998-04-01 | 2001-08-28 | Trw Lucasvarity Electric Steering Ltd. | Electric power steering system with boost curve having portions defined by polynomial equations |
CN107848526A (zh) * | 2016-05-25 | 2018-03-27 | Ntn株式会社 | 车辆转弯控制装置 |
CN109844669A (zh) * | 2016-09-29 | 2019-06-04 | 本田技研工业株式会社 | 车辆控制装置 |
JP2019043395A (ja) * | 2017-09-04 | 2019-03-22 | 日産自動車株式会社 | 運転支援車両の走行制御方法及び走行制御装置 |
CN110949370A (zh) * | 2019-03-18 | 2020-04-03 | 长城汽车股份有限公司 | 自动驾驶车辆的安全监测方法、系统及运动控制系统 |
WO2021228657A1 (fr) * | 2020-05-12 | 2021-11-18 | Renault S.A.S | Module de contrôle de trajectoire, dispositif de contrôle de trajectoire et procédé associés |
CN112208515A (zh) * | 2020-10-19 | 2021-01-12 | 一汽解放汽车有限公司 | 一种车辆横向控制方法、装置、设备及介质 |
CN113276833A (zh) * | 2021-05-11 | 2021-08-20 | 上汽通用五菱汽车股份有限公司 | 车辆的横向运动控制方法、控制终端及存储介质 |
CN113386795A (zh) * | 2021-07-05 | 2021-09-14 | 西安电子科技大学芜湖研究院 | 一种自动驾驶车辆智能决策及局部轨迹规划方法及其决策系统 |
CN113581288A (zh) * | 2021-09-01 | 2021-11-02 | 国汽智控(北京)科技有限公司 | 自动驾驶横向偏移动态修正方法、装置、设备及存储介质 |
CN113734279A (zh) * | 2021-09-22 | 2021-12-03 | 重庆长安汽车股份有限公司 | 方向盘角度偏差自动修正方法、系统、车辆及存储介质 |
CN113650609A (zh) * | 2021-09-28 | 2021-11-16 | 中国科学技术大学先进技术研究院 | 基于模糊规则的人机共驾控制权柔性转移方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN114524020B (zh) | 2023-09-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2106936A1 (en) | Adaptive suspension control for a motor vehicle | |
CN106938661B (zh) | 一种平台化电动助力转向系统 | |
CN106553690A (zh) | 车辆用转向装置 | |
CN1963265A (zh) | 车辆行驶控制装置 | |
JP2002178943A (ja) | レーンキープアシスト制御装置 | |
JPH10114239A (ja) | 自動車の縦運動の制御方法及び装置 | |
CN111216713A (zh) | 一种自动驾驶车辆速度预瞄控制方法 | |
CN112660126B (zh) | 用于自适应巡航的车辆协同控制方法、装置及车辆 | |
CN112874504B (zh) | 一种可拓熵权联合控制器控制方法 | |
CN102862507A (zh) | 车辆前照灯的光轴控制器 | |
CN110155059B (zh) | 一种弯道优化控制方法及系统 | |
CN113753021A (zh) | 一种并联混合动力车辆动力域稳态控制方法 | |
CN114056121B (zh) | 电动汽车 | |
CN113593275A (zh) | 一种基于公交信号优先的交叉口网联自动驾驶方法 | |
CN110509923A (zh) | 自动驾驶路径规划方法、系统、计算机可读存储介质及车辆 | |
JP2004114954A (ja) | 車両用運転操作補助装置 | |
CN110687797A (zh) | 一种基于位置和姿态的自适应mpc泊车横向控制方法 | |
CN114228690A (zh) | 一种基于ddpg和迭代控制的自动驾驶车辆侧倾控制方法 | |
CN114524020A (zh) | 一种车辆人机共驾的方向盘角度控制方法 | |
CN113311698B (zh) | 车道保持控制方法、控制装置和车辆 | |
CN112758105B (zh) | 一种自动驾驶车队跟车行驶控制方法、装置及系统 | |
CN109572697B (zh) | 基于模糊控制的特殊路段行进车辆的油门自动控制方法 | |
JP2011131839A (ja) | 運転支援制御装置 | |
CN116872971A (zh) | 一种基于人机协同增强的自动驾驶控制决策方法及系统 | |
CN115257733B (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 |