CN106004996B - 一种智能车转向控制方法及系统 - Google Patents

一种智能车转向控制方法及系统 Download PDF

Info

Publication number
CN106004996B
CN106004996B CN201610461636.5A CN201610461636A CN106004996B CN 106004996 B CN106004996 B CN 106004996B CN 201610461636 A CN201610461636 A CN 201610461636A CN 106004996 B CN106004996 B CN 106004996B
Authority
CN
China
Prior art keywords
corner
vehicle
expectation
expected
expected 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
Application number
CN201610461636.5A
Other languages
English (en)
Other versions
CN106004996A (zh
Inventor
张德兆
高建伟
王肖
王亚
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Idriverplus Technologies Co Ltd
Original Assignee
Beijing Idriverplus Technologies Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Idriverplus Technologies Co Ltd filed Critical Beijing Idriverplus Technologies Co Ltd
Priority to CN201610461636.5A priority Critical patent/CN106004996B/zh
Publication of CN106004996A publication Critical patent/CN106004996A/zh
Application granted granted Critical
Publication of CN106004996B publication Critical patent/CN106004996B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D5/00Power-assisted or power-driven steering
    • B62D5/04Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
    • B62D5/0457Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
    • B62D5/046Controlling the motor
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/001Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits the torque NOT being among the input parameters
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/002Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits computing target steering angles for front or rear wheels

Landscapes

  • Engineering & Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

本发明公开了一种智能车转向控制方法及系统,所述智能车转向控制方法包括以下步骤:采集车辆实际行驶信息和期望路径坐标点;根据采集到的车辆实际行驶信息和期望路径坐标点,按照车辆中心圆弧运动原则,计算并输出当前时刻的主体期望转角θt;根据采集到的车辆实际行驶信息和期望路径坐标点,修正所述主体期望转角θt,以得到最终期望转角;以及使方向盘转向电机按照所述最终期望转角控制车辆转向。本发明能够依据圆弧几何运动精确计算期望转角,并使车辆中心到达期望路径,而且期望转角只需测量自车相关参数和设定预瞄距离,而无其它可调系数,因此有利于提升控制系统的适应性和调试便捷性。

Description

一种智能车转向控制方法及系统
技术领域
本发明属于智能车辆技术领域,特别是关于一种智能车转向控制方法及系统。
背景技术
智能驾驶技术在交通安全、环境保护及缓解交通压力等方面都有巨大的应用潜力,目前已成为发达国家、汽车厂商及科技公司研究的重点。智能驾驶研究涉及机械电子、模式识别、人工智能、控制科学及软件工程等诸多学科知识,其中,智能车转向控制技术是研究的重要内容之一。智能车转向控制技术需要将车辆的转向控制过程平滑过渡,在以安全为前提的情况下尽可能地使转角合理而平滑变化,并考虑车辆行驶舒适性,达到或接近驾驶员的驾驶水平。此外,合理的转向控制技术还需要对各种型号的车辆具有广泛适应性,减少参数的选取和调试,而对于不同的EPS(Electric Power Steering,电动助力转向)电机,需要在算法上做相应地修正,以弥补转向电机的非理想特性。因此,对于不同的车辆和EPS电机特性,合理的转向控制技术都需要有较好的适应性。
发明内容
本发明的目的在于提供一种智能车转向控制方法及系统,其对于不同的车辆和EPS电机特性具有较好的适应性。
为实现上述目的,本发明提供一种智能车转向控制方法,所述智能车转向控制方法包括以下步骤:采集车辆实际行驶信息和期望路径信息;根据采集到的车辆实际行驶信息和期望路径信息,按照车辆中心圆弧运动原则,计算并输出当前时刻的主体期望转角θt;根据采集到的车辆实际行驶信息和期望路径信息,修正所述主体期望转角θt,以得到最终期望转角;以及使方向盘转向电机按照所述最终期望转角控制车辆转向。
进一步地,修正所述主体期望转角θt具体包括偏移角反馈修正,所述偏移角反馈修正的方法包括:根据采集到的期望路径信息获得修正角度Δθ=k1θvr,k1是经验值,θvr为车轴与期望路径方向之间的夹角,期望路径方向为期望路径上距离车辆中心点最近的点与预瞄点之间的连线方向;以及利用修正角度Δθ修正所述主体期望转角θt,得到第一期望转角。
进一步地,修正所述主体期望转角θt具体还包括横向距离偏差修正,所述横向距离偏差修正的方法包括:根据实际行驶信息和期望路径信息中的近处预瞄点,设定近处预瞄点的横向距离偏差范围,所述近处预瞄点为期望路径上距离车辆当前位置比较近的预瞄点;以及比较所述横向距离偏差范围相应的极值转角和所述第一期望转角,确定第二期望转角,第二期望转角确定如下:当所述第一期望转角处于所述横向距离偏差范围内时,所述第一期望转角为所述第二期望转角;当所述第一期望转角处于所述横向距离偏差范围外时,所述横向距离偏差范围相应的极值转角为所述第二期望转角。
进一步地,所述横向距离偏差范围相应的极值转角的获得方法包括:以所述近处预瞄点为基准,经过所述近处预瞄点作垂直于期望路径的垂线,在该垂线上取距离所述近处预瞄点预设距离值的左右两个端点,所述两个端点分别作为预瞄点依据圆弧运动原则即可得出对应所述横向距离偏差范围相应的极值转角。
进一步地,修正所述主体期望转角θt具体还包括未来转角预测修正,所述未来转角预测修正的方法包括:根据车辆实际行驶信息和期望路径信息,计算未来ΔT时刻的预测期望转角;以及比较所述预测期望转角与所述第二期望转角,确定第三期望转角,第三期望转角确定方法包括:当所述预测期望转角位于依据所述第二期望转角确定的预设范围内时,所述预测期望转角为所述第三期望转角;当所述预测期望转角位于依据所述第二期望转角确定的预设范围外时,依据所述第二期望转角确定的预设范围的相应极值为所述第三期望转角。
进一步地,修正所述主体期望转角θt具体还包括转角极大值修正,所述转角极大值修正的方法包括:根据期望路径信息中的极大值预瞄点,确定当前时刻的转角极大值;以及比较所述转角极大值和所述第三期望转角,确定第四期望转角,第四期望转角确定方法包括:当所述第三期望转角大于所述转角极大值时,所述转角极大值为所述第四期望转角;当所述第三期望转角小于或等于所述转角极大值时,所述第三期望转角为所述第四期望转角。
进一步地,根据期望路径信息中的极大值预瞄点,确定当前时刻的转角极大值的方法包括:所述极大值预瞄点为期望路径上的距离车辆中心点最近的点间距为2倍前后轴间距的点,所述极大值预瞄点和期望路径上距离车辆中心点最近的点的连线与车轴之间的夹角为当前时刻的转角极大值。
进一步地,修正所述主体期望转角θt具体还包括转向不足修正,所述转向不足修正的方法包括:根据实际行驶信息和期望路径信息,确定转向不足系数kturn,修正所述第四期望转角,得到最终期望转角。
本发明还提供一种智能车转向控制系统,所述智能车转向控制系统包括:信息采集模块,用于采集车辆实际行驶信息和期望路径信息,并输出;转角获取模块,用于接收所述采集装置采集到的信息,并根据采集到的车辆实际行驶信息和期望路径信息,按照车辆中心圆弧运动原则,计算并输出当前时刻的主体期望转角θt;角度修正模块,用于接收所述转角获取模块计算得到的主体期望转角θt,并根据采集到的车辆实际行驶信息和期望路径信息,修正所述主体期望转角θt,以得到最终期望转角;以及输出模块,用于接收所述角度修正模块输出的最终期望转角,并输出给方向盘转向电机。
本发明由于采取以上技术方案,其具有以下优点:1、本发明可以依据圆弧几何运动精确计算期望转角,并使车辆中心到达期望路径;计算期望转角只需测量自车相关参数和设定预瞄距离,而无其它可调系数,因此有利于提升控制系统的适应性和调试便捷性。2、本发明具有较强的抑制车辆走S弯功能,在期望转角中加入了车和路的偏移角反馈,使车辆更加平滑地跟踪期望路径。3、本发明可以比较精确地控制横向距离偏差,增加了近处预瞄点,并使圆弧经过近处预瞄点附近,从而减小当前路径跟踪误差。4、本发明的未来转角预测可以将未来转角做参考,弥补通讯、响应延时。5、本发明的前轮转角极大值可以限制过大的期望转角值,使得方向盘打角更合理。
附图说明
图1是本发明确定前轮转角算法的流程图。
图2是本发明圆弧确定前轮转角示意图。
图3是本发明偏移角反馈示意图。
图4是本发明横向距离偏差的约束示意图。
图5是本发明(a)当前时刻车辆与道路位置;(b)未来ΔT时刻车辆与道路位置(以道路为定坐标系);(c)未来ΔT时刻车辆与道路位置(以车辆为定坐标系)示意图。
图6是本发明未来时刻预瞄点在当前时刻的投影坐标示意图。
图7是本发明车辆前轮转角极大值示意图。
具体实施方式
在附图中,使用相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面结合附图对本发明的实施例进行详细说明。
在本发明的描述中,术语“中心”、“纵向”、“横向”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明保护范围的限制。
如图1所示,本实施例所提供的智能车转向控制方法,包括以下步骤:
步骤1):采集车辆实际行驶信息和期望路径信息,并获得标准预瞄点的坐标点。
车辆实际行驶信息包括实际车速和实际方向盘转角。其中:实际车速由车速传感器获得,车速传感器可以安装在车体上,通过测量车轮的轮速,以获得实际车速信息。实际方向盘转角的获取方法是:通过方向盘转向电机反馈给车身控制单元的信号,再转化为实际方向盘转角信息。
期望路径信息包括路径上所有点的横纵坐标及其属性,属性可以表示为道路类型、障碍物类型等;期望路径上标准预瞄点为选取的车辆前方一定距离处dpreview的期望路径上的标准预瞄点,例如图2中的标准预瞄点(xt,yt),按照车辆中心圆弧运动原则,假设以固定前轮转角进行圆弧转弯运动,并且正好使车辆中心经过这个标准预瞄点(xt,yt)。
步骤2):根据采集到的车辆实际行驶信息和期望路径信息,按照车辆中心圆弧运动原则,计算并输出当前时刻的主体期望转角θt,其获取方法具体如下:
如图2所示,选取车辆前方一定距离处dpreview的期望路径(Target path)上的标准预瞄点(xt,yt),假设以固定前轮转角进行圆弧转弯运动,并且正好使车辆中心点(M)经过这个标准预瞄点(xt,yt),那么这个前轮中点的转角就是当前时刻的主体期望转角θt,并在下一个采样时间用同样的方法进行更新。
确定圆弧转弯半径R的方法如下:
如果车身朝向正对着标准预瞄点(xt,yt),那么R为无穷大,主体期望转角θt为0。
如果车身没有正对着标准预瞄点(xt,yt),则定义车辆第二轴的中点坐标为(xr,yr),标准预瞄点的坐标为(xt,yt),这两对坐标值为已知,并且圆弧的圆心O一定是在第二轴两轮连线的延长线上,假如要求车辆中心点M由圆弧运动经过预瞄点(xt,yt),那么根据几何关系,车辆运动圆弧的半径为:
其中,dx=|xt-xr|,dy=|yt-yr|,L为前后轴间距。根据车辆中心点M的转弯半径,车辆第二轴中点到圆弧中心O的距离为
则此时主体期望转角θt为:
θt=arctan(L/dr) (2)
主体期望转角θt的正值代表了车辆的左转向,主体期望转角θt的负值代表了车辆的右转向,正、负号的选取可以根据标准预瞄点(xt,yt)在车辆的左右侧来确定。
通过(2)式计算得到的主体期望转角θt是根据车辆和标准预瞄点(xt,yt)的位置准确地计算得出,并且也具有一定的物理含义,避免了参数和系数的选取,从而可以适应不同EPS电机特性的车型。按照车辆中心圆弧运动原则,确定方向盘期望转角所需的参数只有车身前后轴间距以及方向盘与前轮转角的传动比。
步骤3):根据采集到的车辆实际行驶信息和期望路径信息,修正所述主体期望转角θt,以得到最终期望转角。
步骤4):使方向盘转向电机按照所述最终期望转角控制车辆转向。
根据EPS的响应特性作适当的参数微调,通过步骤3),一方面可以在一定程度上弥补EPS硬件响应的缺陷,例如响应延时、角度跟踪精度低等,另一方面可以使车辆更好地跟踪期望路径,减小横向距离偏差、转向角波动等。
在一个实施例中,如图3所示,在(2)式所确定的主体期望转角θt上加入了偏移角反馈Δθ1。修正所述主体期望转角θt具体包括偏移角反馈修正,所述偏移角反馈修正的方法包括:
步骤11):根据采集到的期望路径信息获得修正角度Δθ1=k1θvr,k1是经验值,θvr为车轴与期望路径方向之间的夹角,期望路径方向为期望路径上距离车辆中心点最近的点A与标准预瞄点(xt,yt)之间的连线方向。
步骤12):利用修正角度Δθ1修正主体期望转角θt,得到第一期望转角。
在实际中,由于各种延时、不精确、响应误差等等,造成无法跟踪好路径,比较严重的就是走S弯现象。抑制S弯现象的方法就是当车辆朝偏离路的方向行驶时,加大(2)式中的主体期望转角θt的角度,反之减小。与这种逻辑相符的量可以是车轴与期望路径方向之间的夹角,期望路径方向为期望路径上距离车辆中心点最近的点与标准预瞄点之间的连线方向。这个角度反馈的比例部分作为前轮期望转角的补充,即Δθ1=k1θvr。主体期望转角θt是(2)式的计算值,所以在某些情况下即使Δθ1很大,也不能接收这个太大的值。所以要对Δθ1的最大值进行限制,即如果Δθ1大于这个最大值,就设定为这个最大值。应用中设定Δθ1的绝对值的最大值为对应的方向盘转角的10度。
在一个实施例中,如果标准预瞄点(xt,yt)距离较远,在直道上会出现忽略局部路径变化而抄近道现象,在弯道则会出现严重的先切内道后切外道现象,造成横向距离偏差较大。造成这个问题的原因是车辆当前位置距离标准预瞄点(xt,yt)太远,导致忽略了近处路径的变化。解决办法是增加选取一个近处预瞄点,并对标准预瞄点(xt,yt)给出的所述第一期望转角进行适当修正。
如图4所示,修正所述主体期望转角θt具体还包括横向距离偏差修正,所述横向距离偏差修正的方法包括:
步骤21):根据实际行驶信息和期望路径信息中的近处预瞄点,设定近处预瞄点的横向距离偏差范围。
步骤22):比较所述横向距离偏差范围相应的极值转角和所述第一期望转角,确定第二期望转角,第二期望转角确定方法如下:
步骤221):当所述第一期望转角处于所述横向距离偏差范围内时,所述第一期望转角为所述第二期望转角。
步骤222):当所述第一期望转角处于所述横向距离偏差范围外时,所述横距离偏差范围的相应极值转角为所述第二期望转角。
所述横向距离偏差范围相应的极值转角的获得方法包括:
所述近处预瞄点为期望路径上距离车辆当前位置比较近的点,如图4所示,图中的近处预瞄点B。以近处预瞄点B为基准,经过近处预瞄点B作垂直于期望路径的垂线,在该垂线上取距离近处预瞄点B预设距离值(例如:10cm)的左右两个端点B1和B2,端点B1和B2的坐标点分别是图4中示出的(xnl,ynl)、(xnr,ynr)。端点B1(xnl,ynl)和端点B2(xnr,ynr)代表了近处预瞄点B的横向距离偏差的极限位置,所述横向距离偏差范围相应的极值转角为车辆中心分别经过端点B1(xnl,ynl)和端点B2(xnr,ynr)的前轮转角。
标准预瞄点(xt,yt)所确定的圆弧运动必须穿过由端点B1(xnl,ynl)和端点B2(xnr,ynr)所构成的线段,那么就表示这个转角能够指向近处预瞄点B,并且距离偏差也比较小;如果这个圆弧没有穿过这条线段,那么就取这个线段里接近这个圆弧的端点B1(xnl,ynl)或端点B2(xnr,ynr)作为近处预瞄点,这相当于选取了B1B2线段里的一个转角极限值,也就将近处的距离偏差控制为这个线段的长度的一半。因此,就对横向距离偏差作了比较准确的控制。
在一个实施例中,对未来时刻期望转角做预测,并修正当前时刻的所述第二期望转角。
在车辆运动过程中,当前的方向盘期望转角可以根据当前时刻标准预瞄点来获得,但由于路径的方程未知,下一步或未来一定时间后方向盘预测期望转角如何变化以及变化多么是不知道的,至少是不能精确知道的。假如可以将更远处的路径考虑在内,并获得未来的方向盘预测期望转角,那么对当前时刻的所述第二期望转角有很大的指导意义,可以在一定程度上修正通过当前时刻的所述第二期望转角,从而做出更合理的判断。
修正所述主体期望转角θt具体还包括未来转角预测修正,所述未来转角预测修正的方法包括:
步骤31):根据车辆实际行驶信息和期望路径信息,计算未来ΔT时刻的方向盘预测期望转角。转角预测,就是以当前的方向盘实际转角和当前车速为准,在一定时间ΔT后,计算ΔT后的方向盘预测期望转角,那么这个期望转角相对于当前时刻来说就是未来ΔT时刻的方向盘预测期望转角。由于方向盘转角与前轮有一一对应关系,车辆反馈回来的是方向盘实际转角,此处的“方向盘预测期望转角”等同于“前轮期望转角”。
如图5所示,图(a)表示当前时刻的车辆与期望路径(Target path)的位置关系,以及当前预瞄点位置,并可算出当前的期望转角θt,此处指的是所述第二期望转角。图(b)表示当车辆以当前车速v和当前方向盘实际转角θr运动ΔT时间后的车辆与道路的位置关系,以及在未来时刻的预瞄点位置,并可算出未来时刻的方向盘预测期望转角θtf,图示是以道路为定坐标系,车辆在移动。图(c)表示将图(b)的坐标系转换为以车辆为定坐标系后的位置关系图,那么图(c)算出的未来时刻的方向盘预测期望转角θtf等同于图(b)中的结果。
如图6所示,图中的包括预期路径(Target path)、当前预瞄点(Current previewpoint)和未来预瞄点(Future preview point)。应用转角预瞄的主要工作在于如何获得未来时刻的方向盘预测期望转角θtf,这个工作的第一步便是算出未来预瞄点(xpf,ypf)在当前时刻当前坐标系下的投影坐标(xpfnew,ypfnew)。
车辆以当前车速和转角进行直线或圆弧运动,如果是圆弧运动,则在ΔT时间内会以点O为圆心,以用(1)式算出的Rvehicle为半径作圆心角为Δθ2的圆弧运动。车辆运动后的未来预瞄点为(xpf,ypf),从而可以计算未来的期望转角,其实这就相当于将未来预瞄点(xpf,ypf)沿着车辆运动圆弧的反方向以Rpreview为半径作圆心角为Δθ2的圆弧运动,那么这个圆弧的终点(xpfnew,ypfnew)既是当前时刻当前坐标系下的未来预瞄点(xpf,ypf)的投影。以当前车辆位置,以(xpfnew,ypfnew)为当前预瞄点,即可算出当前时刻的预测期望转角θtf。坐标(xpfnew,ypfnew)的求取可以通过协调式转弯模型或根据转弯半径计算得到。
另外,需要对预测期望转角θtf和所述第二期望转角进行对比,如果两者相差太大,那么以当前期望转角为标准,对预测期望转角进行一定角度(方向盘转角10度)内的限制。
步骤32):比较所述预测期望转角θtf与所述第二期望转角,确定第三期望转角,第三期望转角确定方法包括:
步骤321):当所述预测期望转角θtf位于依据所述第二期望转角确定的预设范围内时,所述预测期望转角θtf为所述第三期望转角。
步骤322):当所述预测期望转角θtf位于依据所述第二期望转角确定的预设范围外时,依据所述第二期望转角确定的预设范围的极值为所述第三期望转角。
上述步骤中,依据所述第二期望转角确定的预设范围为:第二期望转角-Δθ2≤预测期望转角≤第二期望转角+Δθ2。Δθ2是一个比较小的值,就是说预测期望转角与第二期望转角相差不大时,设预测期望转角为第三期望转角。如果相差比较大,设相应的极值为第三期望转角。
应用这种方法的更重要的一方面是针对EPS电机响应延时以及响应不灵敏的修补措施。当车辆通讯有一定延时,如果提前将未来转角发送出去,则可以在一定程度上改善;另外,车辆EPS底层对小角度差不响应的问题可以通过未来更大转角误差的输入来解决,因为如果当前的小角度期望转角误差没响应,那么按照这样的情况下去,未来一定会走偏更多,从而造成更大的转角误差,那么提前把这个更大的转角误差作为期望转角也有利于EPS对当前转角的响应和跟踪。
如图7所示,在一个实施例中,修正所述主体期望转角θt具体还包括转角极大值修正,所述转角极大值修正的方法包括:
步骤41):根据期望路径信息中的极大值预瞄点,确定当前时刻的转角极大值θmax,该转角极大值θmax确定方法包括:
在期望路径上选取极大值预瞄点C,极大值预瞄点C为期望路径上的距离车辆中心点M最近的点D间距为2倍的前后轴间距L的点,该线段DC与车轴的夹角为当前时刻的转角极大θmax值。
步骤42):比较所述转角极大值θmax和所述第三期望转角,确定第四期望转角,第四期望转角确定方法包括:
步骤421):当所述第三期望转角大于所述转角极大值θmax时,所述转角极大值θmax为所述第四期望转角。
步骤422):当所述第三期望转角小于或等于所述转角极大值θmax时,所述第三期望转角为所述第四期望转角。
在实际前轮转向时,由于方向盘的响应时间问题,会造成前轮转角转动延时,即不能立即转到所给的期望转角。前轮转动速度越低,车辆就越容易出现不稳定现象,尤其是在速度较高时。寻找转角极大值是防止前轮转角无谓的增大造成之后方向盘回正时需要更多时间,从而避免当前的延时造成未来的延时累加。
另外,在有些时候,前轮转角不需要转太大,就可以很好地趋向期望路径,这也符合驾驶员开车的习惯。前轮转角极大值是以当前道路的位置和弯曲程度为依据,保证车辆的运动可以缩小当前横向距离偏差的原则下设计和确定的。
根据运动几何关系,当前道路的位置和弯曲程度所确定的最大转角值可以由道路的一条割线与车辆朝向的夹角来代替,这条割线的长度为两倍的前后轴间距。可以通过几何关系证明这个转角极大值足以使当前的横向距离偏差变小。
在一个实施例中,修正所述主体期望转角θt具体还包括转向不足修正,所述转向不足修正的方法包括:
根据实际行驶信息和期望路径信息,具体地,根据实际车速以及横向距离偏差,确定转向不足系数kturn,修正所述第四期望转角,得到最终期望转角。系数kturn与车速和横向距离偏差呈正比例的函数,车速越大、横向距离偏差越大,系数就越大。第四期望转角乘以系数kturn可以得到最终期望转角。
用圆弧法给出的前轮转角对于中性转向的车辆是吻合的,但如果是不足转向的车辆,对于一个弯道,当车速较高地通过时,用圆弧法给出的前轮转角是不足以跟踪好这个弯道的。因此就要根据车速、横向距离偏差来确定一个大于1的转向不足系数kturn,并且kturn也需要设置最大值限制,例如当根据车速、横向距离偏差算出的kturn大于1.2时,那么就限定为1.2。
本发明还提供一种智能车转向控制系统,智能车转向控制系统包括:
信息采集模块,用于采集车辆实际行驶信息和期望路径信息,并输出。
转角获取模块,用于接收所述采集装置采集到的信息,并根据采集到的车辆实际行驶信息和标准预瞄点的坐标点,按照车辆中心圆弧运动原则,计算并输出当前时刻的主体期望转角θt
角度修正模块,用于接收所述转角获取模块计算得到的主体期望转角θt,并根据采集到的车辆实际行驶信息和期望路径信息,修正所述主体期望转角θt,以得到最终期望转角。
输出模块,用于接收所述角度修正模块输出的最终期望转角,并输出给方向盘转向电机。
根据EPS的响应特性作适当的参数微调,通过角度修正模块,一方面可以在一定程度上弥补EPS硬件响应的缺陷,例如响应延时、角度跟踪精度低等,另一方面可以使车辆更好地跟踪期望路径,减小横向距离偏差、转向角波动等。
最后需要指出的是:以上实施例仅用以说明本发明的技术方案,而非对其限制。本领域的普通技术人员应当理解:可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。

Claims (9)

1.一种智能车转向控制方法,其特征在于,包括以下步骤:
采集车辆实际行驶信息和期望路径信息;
根据采集到的车辆实际行驶信息和期望路径信息,按照车辆中心圆弧运动原则,计算并输出当前时刻的主体期望转角θt
根据采集到的车辆实际行驶信息和期望路径信息,修正所述主体期望转角θt,以得到最终期望转角;以及
使方向盘转向电机按照所述最终期望转角控制车辆转向。
2.如权利要求1所述的智能车转向控制方法,其特征在于,修正所述主体期望转角θt具体包括偏移角反馈修正,所述偏移角反馈修正的方法包括:
根据采集到的期望路径信息获得修正角度Δθ=k1θvr,k1是经验值,θvr为车轴与期望路径方向之间的夹角,期望路径方向为期望路径上距离车辆中心点最近的点与标准预瞄点之间的连线方向;以及
利用修正角度Δθ修正所述主体期望转角θt,得到第一期望转角。
3.如权利要求2所述的智能车转向控制方法,其特征在于,修正所述主体期望转角θt具体还包括横向距离偏差修正,所述横向距离偏差修正的方法包括:
根据实际行驶信息和期望路径信息中的近处预瞄点,设定近处预瞄点的横向距离偏差范围,所述近处预瞄点为期望路径上距离车辆当前位置比较近的预瞄点;以及
比较所述横向距离偏差范围相应的极值转角和第一期望转角,确定第二期望转角,第二期望转角确定方法如下:
当所述第一期望转角处于所述横向距离偏差范围内时,所述第一期望转角为所述第二期望转角;
当所述第一期望转角处于所述横向距离偏差范围外时,所述横向距离偏差范围相应的极值转角为所述第二期望转角。
4.如权利要求3所述的智能车转向控制方法,其特征在于,所述横向距离偏差范围相应的极值转角的获得方法包括:
以所述近处预瞄点为基准,经过所述近处预瞄点作垂直于期望路径的垂线,在该垂线上取距离所述近处预瞄点预设距离值的左右两个端点,所述两个端点分别作为预瞄点依据圆弧运动原则即可得出对应所述横向距离偏差范围相应的极值转角。
5.如权利要求4所述的智能车转向控制方法,其特征在于,修正所述主体期望转角θt具体还包括未来转角预测修正,所述未来转角预测修正的方法包括:
根据车辆实际行驶信息和期望路径信息,计算未来ΔT时刻的预测期望转角;以及
比较所述预测期望转角与所述第二期望转角,确定第三期望转角,第三期望转角确定方法包括:
当所述预测期望转角位于依据所述第二期望转角确定的预设范围内时,所述预测期望转角为所述第三期望转角;
当所述预测期望转角位于依据所述第二期望转角确定的预设范围外时,依据所述第二期望转角确定的预设范围的相应极值为所述第三期望转角。
6.如权利要求5所述的智能车转向控制方法,其特征在于,修正所述主体期望转角θt具体还包括转角极大值修正,所述转角极大值修正的方法包括:
根据期望路径信息中的极大值预瞄点,确定当前时刻的转角极大值;以及
比较所述转角极大值和所述第三期望转角,确定第四期望转角,第四期望转角确定方法包括:
当所述第三期望转角大于所述转角极大值时,所述转角极大值为所述第四期望转角;
当所述第三期望转角小于或等于所述转角极大值时,所述第三期望转角为所述第四期望转角。
7.如权利要求6所述的智能车转向控制方法,其特征在于,根据期望路径信息中的极大值预瞄点,确定当前时刻的转角极大值的方法包括:
所述极大值预瞄点为期望路径上的距离期望路径上距离车辆中心点最近的点间距为2倍前后轴间距的点,所述极大值预瞄点和期望路径上距离车辆中心点最近的点的连线与车轴之间的夹角为当前时刻的转角极大值。
8.如权利要求7所述的智能车转向控制方法,其特征在于,修正所述主体期望转角θt具体还包括转向不足修正,所述转向不足修正的方法包括:
根据实际行驶信息和期望路径信息,确定转向不足系数kturn,修正所述第四期望转角,得到最终期望转角。
9.一种智能车转向控制系统,其特征在于,包括:
信息采集模块,用于采集车辆实际行驶信息和期望路径信息,并输出;
转角获取模块,用于接收所述信息采集模块采集到的信息,并根据采集到的车辆实际行驶信息和期望路径信息,按照车辆中心圆弧运动原则,计算并输出当前时刻的主体期望转角θt
角度修正模块,用于接收所述转角获取模块计算得到的主体期望转角θt,并根据采集到的车辆实际行驶信息和期望路径信息,修正所述主体期望转角θt,以得到最终期望转角;以及
输出模块,用于接收所述角度修正模块输出的最终期望转角,并输出给方向盘转向电机。
CN201610461636.5A 2016-06-23 2016-06-23 一种智能车转向控制方法及系统 Active CN106004996B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610461636.5A CN106004996B (zh) 2016-06-23 2016-06-23 一种智能车转向控制方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610461636.5A CN106004996B (zh) 2016-06-23 2016-06-23 一种智能车转向控制方法及系统

Publications (2)

Publication Number Publication Date
CN106004996A CN106004996A (zh) 2016-10-12
CN106004996B true CN106004996B (zh) 2018-12-14

Family

ID=57085979

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610461636.5A Active CN106004996B (zh) 2016-06-23 2016-06-23 一种智能车转向控制方法及系统

Country Status (1)

Country Link
CN (1) CN106004996B (zh)

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108007417B (zh) 2016-10-27 2021-02-05 上海华测导航技术股份有限公司 一种农机自动驾驶控制系统角度传感器自动标定方法
JP6658464B2 (ja) * 2016-11-09 2020-03-04 株式会社デンソー 中立点検出装置、及び操舵制御システム
JP6919349B2 (ja) * 2017-06-09 2021-08-18 株式会社アイシン 走行支援システム
CN107264621B (zh) * 2017-06-15 2019-05-17 驭势科技(北京)有限公司 车辆预瞄距离计算方法、装置、介质及转向控制方法
CN107037818A (zh) * 2017-06-22 2017-08-11 奇瑞汽车股份有限公司 一种无人驾驶汽车的路径跟踪方法
CN107292048B (zh) * 2017-07-05 2020-12-04 合肥工业大学 一种基于veDYNA车道保持方法及系统
CN109383501B (zh) * 2017-08-14 2020-10-02 郑州宇通客车股份有限公司 一种基于预瞄点的车道保持方法及其辅助系统
CN109383500B (zh) * 2017-08-14 2020-09-01 郑州宇通客车股份有限公司 基于预瞄点的车道保持方法及其辅助系统
CN107544520B (zh) * 2017-10-25 2020-09-01 上海联适导航技术有限公司 一种用于四轮载具自动驾驶的控制方法
CN108116497B (zh) * 2017-12-08 2019-09-17 驭势科技(北京)有限公司 用于智能驾驶的转向预瞄点、转向角的确定方法及装置
CN108820039B (zh) * 2018-05-11 2020-08-28 江苏大学 一种无人驾驶车辆弯道横向控制系统及方法
CN108646748A (zh) * 2018-06-05 2018-10-12 北京联合大学 一种场地无人车轨迹跟踪方法及系统
CN109850012B (zh) * 2019-01-24 2020-08-28 驭势科技(北京)有限公司 一种无人车横向控制方法、装置、系统及存储介质
CN109976341B (zh) * 2019-03-21 2022-09-23 驭势科技(北京)有限公司 一种自动驾驶车辆附着路网的方法、车载设备及存储介质
CN110203275A (zh) * 2019-04-09 2019-09-06 丰疆智能科技股份有限公司 用于拖拉机的行驶路径控制方法
CN110203276A (zh) * 2019-04-09 2019-09-06 丰疆智能科技股份有限公司 拖拉机自动驾驶系统
CN112051864B (zh) * 2019-06-06 2024-08-20 北京京东乾石科技有限公司 用于移动目标轨迹跟踪的方法及装置、设备和可读介质
CN113799764B (zh) * 2020-06-11 2022-08-02 上海汽车集团股份有限公司 一种用于车辆四轮转向系统的控制方法及装置
CN112148020B (zh) * 2020-09-10 2021-06-25 无锡卡尔曼导航技术有限公司 一种基于eps的农机自动驾驶系统及控制方法
CN112977613B (zh) * 2021-03-18 2022-03-08 安徽江淮汽车集团股份有限公司 自动驾驶汽车的转向控制方法、装置、设备及存储介质
CN115158453B (zh) * 2021-04-02 2024-04-26 长沙智能驾驶研究院有限公司 车辆转向控制方法、装置、车辆和存储介质
CN114670921A (zh) * 2022-02-17 2022-06-28 江铃汽车股份有限公司 一种车辆转向角度修正方法、系统、存储介质及车辆
CN114954651B (zh) * 2022-06-08 2023-06-16 广东皓耘科技有限公司 转向控制方法、装置、系统和作业机及计算机存储介质

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4956782B2 (ja) * 2006-01-26 2012-06-20 日産自動車株式会社 車両用操舵制御装置
JP4835189B2 (ja) * 2006-02-16 2011-12-14 日産自動車株式会社 旋回挙動制御装置、自動車、及び旋回挙動制御方法
JP2008037188A (ja) * 2006-08-03 2008-02-21 Nissan Motor Co Ltd 車両用操舵制御装置
US8744689B2 (en) * 2007-07-26 2014-06-03 Hitachi, Ltd. Drive controlling apparatus for a vehicle
CN102762434B (zh) * 2010-06-23 2015-07-22 丰田自动车株式会社 车辆行驶控制装置
CN104477231A (zh) * 2014-08-19 2015-04-01 广东技术师范学院 集成电动助力转向和主动转向的组合控制系统

Also Published As

Publication number Publication date
CN106004996A (zh) 2016-10-12

Similar Documents

Publication Publication Date Title
CN106004996B (zh) 一种智能车转向控制方法及系统
CN107544520B (zh) 一种用于四轮载具自动驾驶的控制方法
Liang et al. Automatic parking path optimization based on bezier curve fitting
EP3932761A1 (en) Vehicle abnormal lane change control method, device and system
CN110361013B (zh) 一种用于车辆模型的路径规划系统及方法
CN109927716B (zh) 基于高精度地图的自主垂直泊车方法
CN106275066B (zh) 一种智能车转向控制方法及装置
CN111717189A (zh) 车道保持控制方法、装置及系统
CN103552482B (zh) 一种无轨车辆的电子差速控制方法及装置
CN107037818A (zh) 一种无人驾驶汽车的路径跟踪方法
CN110109451B (zh) 一种考虑路径曲率的新型几何学路径跟踪算法
Fraichard et al. Smooth path planning for cars
CN103121451A (zh) 一种弯路换道轨迹的跟踪控制方法
CN105197010A (zh) 辅助泊车系统以及辅助泊车控制方法
JP2013122743A (ja) 車両用駐車軌跡導出方法
CN110696819B (zh) 一种自动泊车路径规划方法及系统
CN110006419A (zh) 一种基于预瞄的车辆轨迹跟踪点确定方法
CN104181923A (zh) 一种基于直线控制器的智能车辆曲线跟踪方法
CN110262506A (zh) 预瞄点的确认方法、车辆行驶控制方法、装置及设备
CN111086510B (zh) 一种基于预测函数控制的前轮转向车辆车道保持控制方法
CN111114536A (zh) 一种车辆自动泊车控制方法及装置
WO2024001215A1 (zh) 垂直与斜列车位自主泊车的路径规划方法及装置
CN111093145A (zh) 一种割草机器人的定位系统及定位方法
CN107856733A (zh) 一种面向人机和谐的汽车躲避动障碍物控制方法
CN115993089B (zh) 基于pl-icp的在线四舵轮agv内外参标定方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
CB02 Change of applicant information

Address after: 102208 Beijing City, Changping District Huilongguan East Street No. 338 hit off the square B4-006

Applicant after: Beijing Idriverplus Technology Co.,Ltd.

Address before: 102206 Changping road Beijing Changping District city Shahe Town, No. 97 Xinyuan Science Park A block 511

Applicant before: Beijing Idriverplus Technology Co.,Ltd.

COR Change of bibliographic data
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address

Address after: Building C-3, Northern Territory, Zhongguancun Dongsheng Science Park, 66 Xixiaokou Road, Haidian District, Beijing, 100176

Patentee after: Beijing Idriverplus Technology Co.,Ltd.

Address before: B4-006, maker Plaza, 338 East Street, Huilongguan town, Changping District, Beijing 102208

Patentee before: Beijing Idriverplus Technology Co.,Ltd.

CP03 Change of name, title or address