CN107963126A - 一种多轴转向车辆大曲率自动驾驶转向控制方法 - Google Patents
一种多轴转向车辆大曲率自动驾驶转向控制方法 Download PDFInfo
- Publication number
- CN107963126A CN107963126A CN201610913242.9A CN201610913242A CN107963126A CN 107963126 A CN107963126 A CN 107963126A CN 201610913242 A CN201610913242 A CN 201610913242A CN 107963126 A CN107963126 A CN 107963126A
- Authority
- CN
- China
- Prior art keywords
- mrow
- vehicle
- msub
- deviation
- formula
- 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
- 238000000034 method Methods 0.000 title claims abstract description 20
- 238000005070 sampling Methods 0.000 claims description 22
- 238000001514 detection method Methods 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 7
- 238000010586 diagram Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 3
- 238000013461 design Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 238000009440 infrastructure construction Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Classifications
-
- 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/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D1/00—Steering controls, i.e. means for initiating a change of direction of the vehicle
- B62D1/24—Steering controls, i.e. means for initiating a change of direction of the vehicle not vehicle-mounted
- B62D1/28—Steering controls, i.e. means for initiating a change of direction of the vehicle not vehicle-mounted non-mechanical, e.g. following a line or other known markers
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明公开了一种多轴转向车辆大曲率自动驾驶转向控制方法,包括:S1.获取车辆在当前位置的横向偏差Ye(t)和第一航向角偏差并计算车辆在预设的预瞄点位置的横向偏差Y(t)和第二航向角偏差e(l,t);S2.计算车辆的前轮转角的估计量δf;S3.以所述前轮转角的估计量δf为所述第二航向角偏差e(l,t)的反馈,计算车辆航向输入偏差e′;S4.根据所述输入偏差e′计算车辆的期望前轮转角u,控制车辆转向。本发明具有利用前轮转角作为决策控制器的反馈航向,从而模仿人工驾驶在通过急转弯路径时驾驶员采取的“回轮”策略,使得控制的车辆在大曲率半径转弯时,比常规控制方法的控制性能要好,而且,随着偏差的增大,这种优越性越明显的优点。
Description
技术领域
本发明涉及一种多轴转向车辆控制领域,尤其涉及一种多轴转向车辆大曲率自动驾驶转向控制方法。
背景技术
多轴转向胶轮列车是一种新型城市公共客运车辆,其特点表现为胶轮无轨、与传统汽车共享路权、不再沿固定轨道运行、跟踪地面标识线(虚拟轨道)行驶。它既拥有公交车行驶灵活、建设和维护成本低的优点,又具备运输力大的优势,并且克服了地铁、轻轨、有轨电车等基础设施建设和车辆购置成本高,需要专门的电力***和轨道配合设计的缺点。
胶轮列车的一种基于单目视觉的智能驾驶辅助***,通过提取地面标识线参考路径信息,实现车辆自动跟踪中央虚拟轨迹线,如图1所示,可以较好的缓解驾驶员的疲劳,保证车辆行车安全。但胶轮列车最小设计转弯半径仅为15m,因此,完成复杂路径(如大曲率急弯等道路)的跟踪任务是衡量胶轮列车路径跟踪性能的关键指标,往往在平直道路跟踪较好的控制算法,在进行急弯大转向等复杂道路的跟踪时表现不能令人满意。
发明内容
本发明要解决的技术问题就在于:针对现有技术存在的技术问题,本发明提供一种利用前轮转角的绝对方向作为决策控制器的反馈航向,从而模仿人工驾驶在通过急转弯路径时驾驶员采取的“回轮”策略,使得控制的车辆在大曲率半径转弯时,比常规控制方法的控制性能要好,而且,随着偏差的增大,这种优越性越明显的多轴转向车辆大曲率自动驾驶转向控制方法。
为解决上述技术问题,本发明提出的技术方案为:一种多轴转向车辆大曲率自动驾驶转向控制方法,包括如下步骤:
S1.获取车辆在当前位置的横向偏差Ye(t)和第一航向角偏差并计算车辆在预设的预瞄点位置的横向偏差Y(t)和第二航向角偏差e(l,t);
S2.计算车辆的前轮转角的估计量
S3.以所述前轮转角的估计量为所述第二航向角偏差e(l,t)的反馈,计算车辆航向输入偏差e′;
S4.根据所述输入偏差e′计算车辆的期望前轮转角u,控制车辆转向。
作为本发明的进一步改进,所述步骤S1中所述车辆在当前位置的横向偏差Ye(t)和第一航向角偏差均通过车辆的车道线识别模块直接获得。
作为本发明的进一步改进,所述步骤S1中车辆在预设的预瞄点位置的横向偏差Y(t)根据式(1)所示公式计算确定,
式(1)中,Y(l,t)为车辆在预设的预瞄点位置的横向偏差,Ye(t)为车辆在当前位置的横向偏差,l为预瞄距离,为第一航向角偏差,ρ为由车道线识别模块直接确定的道路曲率,U为由车辆速度传感器确定的车辆纵向车速,t为时间。
作为本发明的进一步改进,所述第二航向角偏差e(l,t)根据式(2)所示公式计算确定,
式(2)中,e(l,t)为第二航向角偏差,Y(l,t)为车辆在预设的预瞄点位置的横向偏差,Ye(t)为车辆在当前位置的横向偏差,l为预瞄距离,为第一航向角偏差,ρ为由车道线识别模块直接确定的道路曲率,U为由车辆速度传感器确定的车辆纵向车速,t为时间。
作为本发明的进一步改进,所述步骤S2中车辆的前轮转角的估计量通过式(3)所示公式计算确定,
式(3)中,为车辆的前轮转角的估计量,Δθ为车辆实际航向角在采样周期内的变化量,a为预先确定的车辆质心到车辆前轴的距离,b为预先确定的车辆质心到车辆前轴的距离,U为车辆的纵向车速,T为预先确定的采样周期,m为预先确定的第一节车厢整车质量,ay为侧向加速度,Cαf为预先确定的车辆前轴轮胎侧偏刚度,Cαr为预先确定的车辆前轴轮胎侧偏刚度。
作为本发明的进一步改进,
所述式(3)通过式(4)和式(5)所示公式导出,
式(4)中,R为车辆的运动半径,a为预先确定的车辆质心到车辆前轴的距离,b为预先确定的车辆质心到车辆前轴的距离,为前轮转角的估计量,αf为前轴轮胎侧偏角,αr为后轴轮胎侧偏角,ay为侧向加速度,m为第一节车厢整车质量,Cαf为预先确定的车辆前轴轮胎侧偏刚度,Cαr为预先确定的车辆前轴轮胎侧偏刚度;
Δθ=UT/R (5)
式(5)中,Δθ为车辆实际航向角在采样周期内的变化量,U为车辆的纵向车速,T为采样周期,R为车辆的运动半径。
作为本发明的进一步改进,所述步骤S3中车辆航向输入偏差e′通过式(6)所示公式计算获得,
式(6)中,e′为车辆航向输入偏差,e为第二航向角偏差,为车辆的前轮转角的估计量。
作为本发明的进一步改进,所述步骤S4的具体步骤包括:通过式(7)所示公式计算获得车辆的前轮转向角控制增量Δu,
式(7)中,Δu为前轮转向角控制增量,u(k)为第k(k=0,1,2,…)个采样时刻的期望前轮转向角控制量,Kp为预设的比例系数,Ki为预设的积分系数,Kd为预设的微分系数,e′(k)为第k(k=0,1,2,…)个采样时刻的航向输入偏差;
通过所述车辆的前轮转向角控制增量Δu计算得到车辆的期望前轮转角u,以所述车辆的期望前轮转角u控制车辆转向。
与现有技术相比,本发明的优点在于:本发明利用前轮转角的绝对方向作为决策控制器的反馈航向,而不是车辆航向,从而模仿人工驾驶在通过急转弯路径时驾驶员采取的“回轮”策略,使得控制的车辆在大曲率半径转弯时,比常规控制方法的控制性能要好,而且,随着偏差的增大,这种优越性越明显。
附图说明
图1为本发明具有视觉识别中央虚拟轨迹线的自动驾驶车辆示意图。
图2为本发明具体实施例流程示意图。
图3为本发明具体实施例前轮转角反馈控制原理示意图。
图4为本发明具体实施例车-路几何关系和摄像头视野图像平面示意图。
图5为本发明具体实施例第一节车辆二自由度前轮转角估计模型示意图。
图6为本发明具体实施例控制结果轨迹跟随示意图。
具体实施方式
以下结合说明书附图和具体优选的实施例对本发明作进一步描述,但并不因此而限制本发明的保护范围。
如图1所示,本实施例应用的胶轮列车具有基于单目视觉的智能驾驶辅助***,通过提取地面标识线参考路径信息,自动获取相应的转向参数,实现车辆自动跟踪中央虚拟轨迹线,进行自动驾驶。
如图2所示,本实施例多轴转向车辆大曲率自动驾驶转向控制方法,包括如下步骤:S1.获取车辆在当前位置的横向偏差Ye(t)和第一航向角偏差并计算车辆在预设的预瞄点位置的横向偏差Y(t)和第二航向角偏差e(l,t);S2.计算车辆的前轮转角的估计量S3.以前轮转角的估计量为第二航向角偏差e(l,t)的反馈,计算车辆航向输入偏差e′;S4.根据输入偏差e′计算车辆的期望前轮转角u,控制车辆转向。在本实施例中,如图2中所示,当前位置的横向偏差Ye(t)为车辆在当前位置前轴中心距中央车道线中心的横向距离,在预设的预瞄点位置的横向偏差Y(t)为车辆在预瞄点处车辆前轴中心距中央车道线的横向距离,第一航向角偏差为车辆航向与纵向(X轴)之间的夹角,第二航向角偏差e(l,t)为车辆当前位置与预瞄点之间的连线与纵向(X轴)之间的夹角。
如图3所示,在现有的控制技术中,仅仅使用车辆的实际航向作为反馈,则决策控制器的航向输入偏差可理解表示为e=θd-θ,e为第二航向角偏差,θd为期望航向角,θ为车辆实际航向角。在本实施例的技术方案中,同时还以车辆前轮转角的估计量作为决策控制器的反馈量,则决策控制器的输入偏差e′表示为即式(6)所示形式。
在本实施例中,步骤S1中车辆在当前位置的横向偏差Ye(t)和第一航向角偏差均通过车辆的车道线识别模块直接获得。步骤S1中车辆在预设的预瞄点位置的横向偏差Y(t)根据式(1)所示公式计算确定,
式(1)中,Y(l,t)为车辆在预设的预瞄点位置的横向偏差,Ye(t)为当前位置的横向偏差,l为预瞄距离,为第一航向角偏差,ρ为由车道线识别模块直接确定的道路曲率,U为由车辆速度传感器确定的车辆纵向车速,t为时间。在本实施例中,预瞄距离l可通过车道线识别模块直接获取。
第二航向角偏差e(l,t)根据式(2)所示公式计算确定,
式(2)中,e(l,t)为第二航向角偏差,Y(l,t)为车辆在预设的预瞄点位置的横向偏差,Ye(t)为当前位置的横向偏差,l为预瞄距离,为第一航向角偏差,ρ为由车道线识别模块直接确定的道路曲率,U为由车辆速度传感器确定的车辆纵向车速,t为时间。
如图4所示,描述了车辆与车道线之间的几何关系和摄像头视野图像平面,其中l为预瞄距离,通过车道线识别模块计算,可直接得到车辆在当前位置的横向偏差Ye(t)和第一航向角偏差当前位置的横向偏差Ye(t)即车辆前轴中心距中央车道线中心之间的偏差。
而预瞄点处与车道线的横向偏差如式(8)所示,即
式(7)中,Y(l,t)为车辆在预设的预瞄点位置的横向偏差,其中,为由车辆距车道线的侧向距离偏差和车辆航向角所引起的横向偏差,为道路曲率引起的横向位移变化量。l为预瞄距离,Ye(t)为当前位置的横向偏差,通过车道线识别模块直接获得,为第一航向角偏差,通过车道线识别模块直接获得,ρ为由车道线识别模块直接确定的道路曲率,S为车道线识别模块中确定的弧长,t为时间。是基于路面曲线S坐标系进行积分,将其转换到基于车辆坐标系XY进行积分,得到对曲线曲率ρ(X,t)进行一次积分得到曲线斜率,对曲线斜率进行一次积分得到偏置距离,因此通过对Yc(l,t)进行两次积分,得到了预瞄处因道路曲率引起的横向偏差。
通过假设道路曲率为线性变化,令ρ(X,t)=KX,式中K为曲率变化系数,因此则式(8)可以简化为式(9)所示形式,
式(9)中各参数的定义与式(8)中相同。U为由车辆速度传感器确定的车辆纵向车速。
假设车辆总是跟踪车道线行驶,则式(9)可以转换为式(10)所示形式,
据此,根据图4中所示的三角形中的三角关系,可得到如式(2)所示的第二航向角偏差。
在本实施例中,步骤S2中车辆的前轮转角的估计量通过式(3)所示公式计算确定,
式(3)中,为车辆的前轮转角的估计量,Δθ为车辆实际航向角在采样周期内的变化量,a为预先确定的车辆质心到车辆前轴的距离,b为预先确定的车辆质心到车辆前轴的距离,U为车辆的纵向车速,T为预先确定的采样周期,m为预先确定的第一节车厢整车质量,ay为侧向加速度,Cαf为预先确定的车辆前轴轮胎侧偏刚度,Cαr为预先确定的车辆前轴轮胎侧偏刚度。在本实施例中,预先确定的采样周期T取车辆的控制器的采样周期,车辆纵向车速U可以通过轮速传感器测量得到,侧向加速度ay可通过列车的陀螺仪直接测量得到,且
如图5所示,在本实施例中,所述式(3)通过式(4)和式(5)所示公式导出,
式(4)中,R为车辆的运动半径,a为预先确定的车辆质心到车辆前轴的距离,b为预先确定的车辆质心到车辆前轴的距离,为前轮转角的估计量,αf为前轴轮胎侧偏角,αr为后轴轮胎侧偏角,ay为侧向加速度,m为第一节车厢整车质量,Cαf为预先确定的车辆前轴轮胎侧偏刚度,Cαr为预先确定的车辆前轴轮胎侧偏刚度。
Δθ=UT/R (5)
式(5)中,Δθ为车辆实际航向角在采样周期内的变化量,U为车辆的纵向车速,T为采样周期,R为车辆的运动半径。
将式(4)代入式(5),即可得到车辆实际航向角在采样周期内的变化量Δθ如式(11)所示,
式(11)中对各参数的定义与式(4)和式(5)中相同。
通过式(11)进行变形即可确定如式(3)所示的前轮转角的估计量表示形式。
设当前控制周期(采样周期)内自动驾驶车辆的航向值为θ(k),前一个周期航向值为θ(k-1),则可以确定在一个控制周期内车辆实际航向角的变化量Δθ如式(12)所示,
Δθ=θ(k)-θ(k-1) (12)
通过以上推算,可以得出,只需要知道当前控制周期内的车辆实际航向角θ(k),上一个控制周期内的车辆实际航向角θ(k-1),车辆的纵向速度U,以及预先确定的车辆质心到车辆前轴的距离a,预先确定的车辆质心到车辆前轴的距离b,即可确定前轴车轮转角。
在本实施例中,步骤S3中车辆航向输入偏差e′通过式(6)所示公式计算获得,
式(6)中,e′为车辆航向输入偏差,e为第二航向角偏差,为车辆的前轮转角的估计量。
在本实施例中,在计算确定决策控制器的输入偏差e′之后,即可采用增量PID算法,通过式(7)所示公式计算获得车辆的前轮转向角控制增量Δu,
式(7)中,Δu为前轮转向角控制增量,u(k)为第k(k=0,1,2,…)个采样时刻的期望前轮转向角控制量,Kp为预设的比例系数,Ki为预设的积分系数,Kd为预设的微分系数,e′(k)为第k(k=0,1,2,…)个采样时刻的航向输入偏差;通过车辆的前轮转向角控制增量Δu计算得到车辆的期望前轮转角u,以车辆的期望前轮转角u控制车辆转向。
由于Δu=u(k)-u(k-1),u(k-1)为已知的上一个控制周期的前轮转角控制量,即可通过u(k)=Δu+u(k-1)确定所需要的车辆的期望前轮转角u(k),通过CAN总线将期望前轮转角u(k)发送给线控转向***进行执行,控制车辆转向。
在本实施例中,利用前轮转角的绝对方向作为决策控制器的反馈航向,而不是车辆航向本身,从而模仿人工驾驶在通过急转弯路径时驾驶员采取的“回轮”策略,使得控制的车辆在大曲率半径转弯时,比常规控制方法的控制性能要好,而且,随着偏差的增大,这种优越性越明显。车辆的行驶轨迹如图6所示。
上述只是本发明的较佳实施例,并非对本发明作任何形式上的限制。虽然本发明已以较佳实施例揭露如上,然而并非用以限定本发明。因此,凡是未脱离本发明技术方案的内容,依据本发明技术实质对以上实施例所做的任何简单修改、等同变化及修饰,均应落在本发明技术方案保护的范围内。
Claims (8)
1.一种多轴转向车辆大曲率自动驾驶转向控制方法,其特征在于,包括如下步骤:
S1.获取车辆在当前位置的横向偏差Ye(t)和第一航向角偏差并计算车辆在预设的预瞄点位置的横向偏差Y(t)和第二航向角偏差e(l,t);
S2.计算车辆的前轮转角的估计量
S3.以所述前轮转角的估计量为所述第二航向角偏差e(l,t)的反馈,计算车辆航向输入偏差e′;
S4.根据所述输入偏差e′计算车辆的期望前轮转角u,控制车辆转向。
2.根据权利要求1所述的多轴转向车辆大曲率自动驾驶转向控制方法,其特征在于:所述步骤S1中所述车辆在当前位置的横向偏差Ye(t)和第一航向角偏差均通过车辆的车道线识别模块直接获得。
3.根据权利要求2所述的多轴转向车辆大曲率自动驾驶转向控制方法,其特征在于:所述步骤S1中车辆在预设的预瞄点位置的横向偏差Y(t)根据式(1)所示公式计算确定,
式(1)中,Y(l,t)为车辆在预设的预瞄点位置的横向偏差,Ye(t)为车辆在当前位置的横向偏差,l为预瞄距离,为第一航向角偏差,ρ为由车道线识别模块直接确定的道路曲率,U为由车辆速度传感器确定的车辆纵向车速,t为时间。
4.根据权利要求3所述的多轴转向车辆大曲率自动驾驶转向控制方法,其特征在于:所述第二航向角偏差e(l,t)根据式(2)所示公式计算确定,
式(2)中,e(l,t)为第二航向角偏差,Y(l,t)为车辆在预设的预瞄点位置的横向偏差,Ye(t)为车辆在当前位置的横向偏差,l为预瞄距离,为第一航向角偏差,ρ为由车道线识别模块直接确定的道路曲率,U为由车辆速度传感器确定的车辆纵向车速,t为时间。
5.根据权利要求1至4任一项所述的多轴转向车辆大曲率自动驾驶转向控制方法,其特征在于:所述步骤S2中车辆的前轮转角的估计量通过式(3)所示公式计算确定,
<mrow>
<msub>
<mover>
<mi>&delta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>f</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>&Delta;</mi>
<mi>&theta;</mi>
<mrow>
<mo>(</mo>
<mi>a</mi>
<mo>+</mo>
<mi>b</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>U</mi>
<mi>T</mi>
</mrow>
</mfrac>
<mo>+</mo>
<mfrac>
<mrow>
<msub>
<mi>ma</mi>
<mi>y</mi>
</msub>
</mrow>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<mi>a</mi>
<mo>+</mo>
<mi>b</mi>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mrow>
<mo>(</mo>
<mfrac>
<mi>b</mi>
<msub>
<mi>C</mi>
<mrow>
<mi>&alpha;</mi>
<mi>f</mi>
</mrow>
</msub>
</mfrac>
<mo>-</mo>
<mfrac>
<mi>a</mi>
<msub>
<mi>C</mi>
<mrow>
<mi>&alpha;</mi>
<mi>r</mi>
</mrow>
</msub>
</mfrac>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
式(3)中,为车辆的前轮转角的估计量,Δθ为车辆实际航向角在采样周期内的变化量,a为预先确定的车辆质心到车辆前轴的距离,b为预先确定的车辆质心到车辆前轴的距离,U为车辆的纵向车速,T为预先确定的采样周期,m为预先确定的第一节车厢整车质量,ay为侧向加速度,Cαf为预先确定的车辆前轴轮胎侧偏刚度,Cαr为预先确定的车辆前轴轮胎侧偏刚度。
6.根据权利要求5所述的多轴转向车辆大曲率自动驾驶转向控制方法,其特征在于:所述式(3)通过式(4)和式(5)所示公式导出,
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>R</mi>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mi>a</mi>
<mo>+</mo>
<mi>b</mi>
<mo>)</mo>
</mrow>
<mo>/</mo>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&delta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>f</mi>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mi>f</mi>
</msub>
<mo>+</mo>
<msub>
<mi>&alpha;</mi>
<mi>r</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&alpha;</mi>
<mi>f</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>m</mi>
<mi>b</mi>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>C</mi>
<mrow>
<mi>&alpha;</mi>
<mi>f</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>a</mi>
<mo>+</mo>
<mi>b</mi>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<msub>
<mi>a</mi>
<mi>y</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&alpha;</mi>
<mi>r</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>m</mi>
<mi>a</mi>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>C</mi>
<mrow>
<mi>&alpha;</mi>
<mi>r</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>a</mi>
<mo>+</mo>
<mi>b</mi>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<msub>
<mi>a</mi>
<mi>y</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
式(4)中,R为车辆的运动半径,a为预先确定的车辆质心到车辆前轴的距离,b为预先确定的车辆质心到车辆前轴的距离,为前轮转角的估计量,αf为前轴轮胎侧偏角,αr为后轴轮胎侧偏角,ay为侧向加速度,m为第一节车厢整车质量,Cαf为预先确定的车辆前轴轮胎侧偏刚度,Cαr为预先确定的车辆前轴轮胎侧偏刚度;
Δθ=UT/R (5)
式(5)中,Δθ为车辆实际航向角在采样周期内的变化量,U为车辆的纵向车速,T为采样周期,R为车辆的运动半径。
7.根据权利要求6所述的多轴转向车辆大曲率自动驾驶转向控制方法,其特征在于:所述步骤S3中车辆航向输入偏差e′通过式(6)所示公式计算获得,
<mrow>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mi>e</mi>
<mo>-</mo>
<msub>
<mover>
<mi>&delta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>f</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
式(6)中,e′为车辆航向输入偏差,e为第二航向角偏差,为车辆的前轮转角的估计量。
8.根据权利要求7所述的多轴转向车辆大曲率自动驾驶转向控制方法,其特征在于:所述步骤S4的具体步骤包括:通过式(7)所示公式计算获得车辆的前轮转向角控制增量Δu,
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<mi>&Delta;</mi>
<mi>u</mi>
<mo>=</mo>
<mi>u</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>u</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>p</mi>
</msub>
<mo>&lsqb;</mo>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>i</mi>
</msub>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>d</mi>
</msub>
<mo>&lsqb;</mo>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mn>2</mn>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
式(7)中,Δu为前轮转向角控制增量,u(k)为第k(k=0,1,2,…)个采样时刻的期望前轮转向角控制量,Kp为预设的比例系数,Ki为预设的积分系数,Kd为预设的微分系数,e′(k)为第k(k=0,1,2,…)个采样时刻的航向输入偏差;
通过所述车辆的前轮转向角控制增量Δu计算得到车辆的期望前轮转角u,以所述车辆的期望前轮转角u控制车辆转向。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610913242.9A CN107963126B (zh) | 2016-10-19 | 2016-10-19 | 一种多轴转向车辆大曲率自动驾驶转向控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610913242.9A CN107963126B (zh) | 2016-10-19 | 2016-10-19 | 一种多轴转向车辆大曲率自动驾驶转向控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107963126A true CN107963126A (zh) | 2018-04-27 |
CN107963126B CN107963126B (zh) | 2020-03-17 |
Family
ID=61997090
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610913242.9A Active CN107963126B (zh) | 2016-10-19 | 2016-10-19 | 一种多轴转向车辆大曲率自动驾驶转向控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107963126B (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108646747A (zh) * | 2018-06-05 | 2018-10-12 | 上海交通大学 | 农用车辆路径跟踪控制方法 |
CN109976341A (zh) * | 2019-03-21 | 2019-07-05 | 驭势科技(北京)有限公司 | 一种自动驾驶车辆附着路网的方法、车载设备及存储介质 |
CN110109451A (zh) * | 2019-04-10 | 2019-08-09 | 东南大学 | 一种考虑路径曲率的新型几何学路径跟踪算法 |
CN110316249A (zh) * | 2019-07-25 | 2019-10-11 | 北京智行者科技有限公司 | 横向控制方法及装置 |
CN110398969A (zh) * | 2019-08-01 | 2019-11-01 | 北京主线科技有限公司 | 自动驾驶车辆自适应预测时域转向控制方法及装置 |
CN111158377A (zh) * | 2020-01-15 | 2020-05-15 | 浙江吉利汽车研究院有限公司 | 一种用于车辆的横向控制方法、***及车辆 |
CN111487966A (zh) * | 2020-04-13 | 2020-08-04 | 哈尔滨工程大学 | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 |
CN111610780A (zh) * | 2019-02-25 | 2020-09-01 | 广州汽车集团股份有限公司 | 一种自动驾驶车路径跟踪控制方法及其装置 |
CN111923916A (zh) * | 2020-07-24 | 2020-11-13 | 江苏大学 | 一种基于视觉感知行为和anfis的仿人转向建模方法及转向控制*** |
CN112100565A (zh) * | 2020-08-31 | 2020-12-18 | 中国第一汽车股份有限公司 | 一种道路曲率确定方法、装置、设备及存储介质 |
CN112622895A (zh) * | 2020-12-30 | 2021-04-09 | 威伯科汽车控制***(中国)有限公司 | 一种应用于自动驾驶的轨迹控制的预估控制方法 |
CN113552888A (zh) * | 2021-07-29 | 2021-10-26 | 中国第一汽车股份有限公司 | 应用于无人车的行驶轨迹控制方法、装置、设备及介质 |
CN113581289A (zh) * | 2021-09-01 | 2021-11-02 | 国汽智控(北京)科技有限公司 | 零位偏差动态标定方法、装置、电子设备及存储介质 |
CN113696969A (zh) * | 2021-09-02 | 2021-11-26 | 浙江吉利控股集团有限公司 | 一种车辆的转向控制方法、转向控制***及车辆 |
CN114620050A (zh) * | 2022-03-28 | 2022-06-14 | 徐州华宝能源科技有限公司 | 基于大数据与云计算的疲劳驾驶检测方法及*** |
CN117519136A (zh) * | 2023-10-21 | 2024-02-06 | 哈尔滨理工大学 | 一种考虑大曲率转弯的无人艇路径跟踪方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006005124A1 (en) * | 2004-07-13 | 2006-01-19 | Gene Kostecki | Multiaxle vehicle with steerable rear wheels |
DE102005048321B4 (de) * | 2005-10-08 | 2008-10-09 | Linseal Gmbh | Antriebsvorrichtung |
CN101293533A (zh) * | 2008-05-12 | 2008-10-29 | 吉林大学 | 多轴转向车辆的转向控制***和控制方法 |
RU2423281C1 (ru) * | 2010-03-16 | 2011-07-10 | Государственное образовательное учреждение высшего профессионального образования "Тюменский государственный нефтегазовый университет" | Колесная транспортная система |
CN203651885U (zh) * | 2013-11-29 | 2014-06-18 | 北汽福田汽车股份有限公司 | 一种用于重型车辆的辅助转向控制*** |
CN104977933A (zh) * | 2015-07-01 | 2015-10-14 | 吉林大学 | 一种自主驾驶车辆的区域型路径跟踪控制方法 |
CN105667588A (zh) * | 2016-03-17 | 2016-06-15 | 南通润邦重机有限公司 | 一种多轴全轮转向装置及具有该装置的工程机械 |
-
2016
- 2016-10-19 CN CN201610913242.9A patent/CN107963126B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006005124A1 (en) * | 2004-07-13 | 2006-01-19 | Gene Kostecki | Multiaxle vehicle with steerable rear wheels |
DE102005048321B4 (de) * | 2005-10-08 | 2008-10-09 | Linseal Gmbh | Antriebsvorrichtung |
CN101293533A (zh) * | 2008-05-12 | 2008-10-29 | 吉林大学 | 多轴转向车辆的转向控制***和控制方法 |
RU2423281C1 (ru) * | 2010-03-16 | 2011-07-10 | Государственное образовательное учреждение высшего профессионального образования "Тюменский государственный нефтегазовый университет" | Колесная транспортная система |
CN203651885U (zh) * | 2013-11-29 | 2014-06-18 | 北汽福田汽车股份有限公司 | 一种用于重型车辆的辅助转向控制*** |
CN104977933A (zh) * | 2015-07-01 | 2015-10-14 | 吉林大学 | 一种自主驾驶车辆的区域型路径跟踪控制方法 |
CN105667588A (zh) * | 2016-03-17 | 2016-06-15 | 南通润邦重机有限公司 | 一种多轴全轮转向装置及具有该装置的工程机械 |
Cited By (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108646747A (zh) * | 2018-06-05 | 2018-10-12 | 上海交通大学 | 农用车辆路径跟踪控制方法 |
CN111610780B (zh) * | 2019-02-25 | 2023-03-21 | 广州汽车集团股份有限公司 | 一种自动驾驶车路径跟踪控制方法及其装置 |
CN111610780A (zh) * | 2019-02-25 | 2020-09-01 | 广州汽车集团股份有限公司 | 一种自动驾驶车路径跟踪控制方法及其装置 |
CN109976341A (zh) * | 2019-03-21 | 2019-07-05 | 驭势科技(北京)有限公司 | 一种自动驾驶车辆附着路网的方法、车载设备及存储介质 |
CN110109451A (zh) * | 2019-04-10 | 2019-08-09 | 东南大学 | 一种考虑路径曲率的新型几何学路径跟踪算法 |
CN110109451B (zh) * | 2019-04-10 | 2022-07-12 | 东南大学 | 一种考虑路径曲率的新型几何学路径跟踪算法 |
CN110316249A (zh) * | 2019-07-25 | 2019-10-11 | 北京智行者科技有限公司 | 横向控制方法及装置 |
CN110316249B (zh) * | 2019-07-25 | 2020-06-26 | 北京智行者科技有限公司 | 横向控制方法及装置 |
CN110398969A (zh) * | 2019-08-01 | 2019-11-01 | 北京主线科技有限公司 | 自动驾驶车辆自适应预测时域转向控制方法及装置 |
CN111158377B (zh) * | 2020-01-15 | 2021-04-27 | 浙江吉利汽车研究院有限公司 | 一种用于车辆的横向控制方法、***及车辆 |
CN111158377A (zh) * | 2020-01-15 | 2020-05-15 | 浙江吉利汽车研究院有限公司 | 一种用于车辆的横向控制方法、***及车辆 |
CN111487966B (zh) * | 2020-04-13 | 2022-09-09 | 哈尔滨工程大学 | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 |
CN111487966A (zh) * | 2020-04-13 | 2020-08-04 | 哈尔滨工程大学 | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 |
CN111923916B (zh) * | 2020-07-24 | 2022-03-29 | 江苏大学 | 一种基于视觉感知行为和anfis的仿人转向建模方法及转向控制*** |
CN111923916A (zh) * | 2020-07-24 | 2020-11-13 | 江苏大学 | 一种基于视觉感知行为和anfis的仿人转向建模方法及转向控制*** |
CN112100565A (zh) * | 2020-08-31 | 2020-12-18 | 中国第一汽车股份有限公司 | 一种道路曲率确定方法、装置、设备及存储介质 |
CN112622895B (zh) * | 2020-12-30 | 2022-07-08 | 采埃孚商用车***(青岛)有限公司 | 一种应用于自动驾驶的轨迹控制的预估控制方法 |
CN112622895A (zh) * | 2020-12-30 | 2021-04-09 | 威伯科汽车控制***(中国)有限公司 | 一种应用于自动驾驶的轨迹控制的预估控制方法 |
CN113552888B (zh) * | 2021-07-29 | 2022-07-19 | 中国第一汽车股份有限公司 | 应用于无人车的行驶轨迹控制方法、装置、设备及介质 |
CN113552888A (zh) * | 2021-07-29 | 2021-10-26 | 中国第一汽车股份有限公司 | 应用于无人车的行驶轨迹控制方法、装置、设备及介质 |
CN113581289A (zh) * | 2021-09-01 | 2021-11-02 | 国汽智控(北京)科技有限公司 | 零位偏差动态标定方法、装置、电子设备及存储介质 |
CN113696969A (zh) * | 2021-09-02 | 2021-11-26 | 浙江吉利控股集团有限公司 | 一种车辆的转向控制方法、转向控制***及车辆 |
CN113696969B (zh) * | 2021-09-02 | 2022-07-26 | 浙江吉利控股集团有限公司 | 一种车辆的转向控制方法、转向控制***及车辆 |
CN114620050A (zh) * | 2022-03-28 | 2022-06-14 | 徐州华宝能源科技有限公司 | 基于大数据与云计算的疲劳驾驶检测方法及*** |
CN114620050B (zh) * | 2022-03-28 | 2023-01-03 | 徐州华宝能源科技有限公司 | 基于大数据与云计算的疲劳驾驶检测方法及*** |
CN117519136A (zh) * | 2023-10-21 | 2024-02-06 | 哈尔滨理工大学 | 一种考虑大曲率转弯的无人艇路径跟踪方法 |
CN117519136B (zh) * | 2023-10-21 | 2024-05-17 | 哈尔滨理工大学 | 一种考虑大曲率转弯的无人艇路径跟踪方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107963126B (zh) | 2020-03-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107963126A (zh) | 一种多轴转向车辆大曲率自动驾驶转向控制方法 | |
CN107933686B (zh) | 一种多轴转向车辆跟踪中央车道线转向控制方法及*** | |
CN109669461B (zh) | 一种复杂工况下自动驾驶车辆决策***及其轨迹规划方法 | |
CN111033176B (zh) | 地图信息提供*** | |
CN108482379B (zh) | 轮毂电机驱动车辆路面附着系数及路面坡度同步实时估算***及方法 | |
CN106476883B (zh) | 车辆的行驶控制装置 | |
US10828953B2 (en) | Self-driving vehicle with integrated active suspension | |
CN103935265B (zh) | 一种电动汽车的车身稳定控制*** | |
CN106114511B (zh) | 一种汽车巡航***关键目标识别方法 | |
CN105984461B (zh) | 车辆的行驶控制装置 | |
CN101837781B (zh) | 用于自动车道对正或换道的控制***的基于模型的预测控制 | |
CN103121447B (zh) | 一种弯道防侧滑侧翻自动控制***及方法 | |
CN101965286B (zh) | 车道保持辅助装置和车道保持辅助方法 | |
US9963007B2 (en) | Method for compensating for an inclination | |
CN105835721B (zh) | 一种四轮轮毂电动汽车车速控制方法 | |
CN104061899B (zh) | 一种基于卡尔曼滤波的车辆侧倾角与俯仰角估计方法 | |
CN109649393A (zh) | 一种自动驾驶变换车道的路径规划方法及装置 | |
CN109606368B (zh) | 一种智能汽车可拓车速自适应变化轨迹跟踪控制方法 | |
CN109080627B (zh) | 一种无人驾驶车辆转弯行驶时侧向力控制方法 | |
CN111016898B (zh) | 一种智能车轨迹换道规划方法 | |
CN109733474A (zh) | 一种基于分段仿射分层控制的智能车转向控制***及方法 | |
CN105549584B (zh) | 自导向循迹运行的列车 | |
CN107021104A (zh) | 一种车道识别补偿方法和装置 | |
CN108860149A (zh) | 一种用于智能车辆时间最短自由变道的运动轨迹设计方法 | |
CN104331611A (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 |