CN116080754B - 一种车辆自主驾驶横向控制方法 - Google Patents

一种车辆自主驾驶横向控制方法 Download PDF

Info

Publication number
CN116080754B
CN116080754B CN202310366227.7A CN202310366227A CN116080754B CN 116080754 B CN116080754 B CN 116080754B CN 202310366227 A CN202310366227 A CN 202310366227A CN 116080754 B CN116080754 B CN 116080754B
Authority
CN
China
Prior art keywords
vehicle
point
attitude angle
lateral
angle
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
CN202310366227.7A
Other languages
English (en)
Other versions
CN116080754A (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.)
Changzhou Xingyu Automotive Lighting Systems Co Ltd
Original Assignee
Changzhou Xingyu Automotive Lighting Systems 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 Changzhou Xingyu Automotive Lighting Systems Co Ltd filed Critical Changzhou Xingyu Automotive Lighting Systems Co Ltd
Priority to CN202310366227.7A priority Critical patent/CN116080754B/zh
Publication of CN116080754A publication Critical patent/CN116080754A/zh
Application granted granted Critical
Publication of CN116080754B publication Critical patent/CN116080754B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • B62D6/008—Control of feed-back to the steering input member, e.g. simulating road feel in steer-by-wire applications

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

本发明公开了一种车辆自主驾驶横向控制方法，它包括：步骤S1、采集车辆摄像头输出的车道线信息和目标障碍物信息，然后采集EPS电子助力转向控制器、ESC车辆稳定系统和IMU惯性传感器输出的车辆状态信息；步骤S2、对车道线信息、目标障碍物信息和车辆状态信息进行信号处理；步骤S3、对驾驶员意图进行识别；步骤S4、计算预瞄点的横向控制偏差值和车身姿态角；步骤S5、根据预瞄点的横向控制偏差值，计算车辆期望的姿态角；步骤S6、根据车辆期望的姿态角，计算车辆期望的姿态角控制偏差值。本发明提供一种车辆自主驾驶横向控制方法，保证车辆行驶在满足特定条件的车道线内，安全且高效。

Description

一种车辆自主驾驶横向控制方法
技术领域
本发明涉及一种车辆自主驾驶横向控制方法，属于车辆导航技术领域。
背景技术
目前，现有技术中，常用的车辆横向控制功能中对于EPS电子助力转向控制器转向干预的转矩常用的计算方法如下：
通过对横向位置偏差或者横向偏航角偏差进行PID控制得到EPS电子助力转向控制器的执行转角
Figure SMS_1
；
通过对横摆角速度偏差进行PID控制得到EPS的执行转矩Tcmd；
通过对横向位置偏差进行比例和积分控制得到EPS的执行转矩Tcmd1以及对车辆的航向角偏差进行比例和积分控制得到EPS的执行转矩Tcmd2，然后对这两个执行扭矩进行加权求和：
Figure SMS_2
。
当前的方法是利用车辆的横向位置或者横向偏航角通过特定的算法（PID控制、LQR控制等）计算出期望的EPS转角或者EPS转矩，存在的缺陷也非常明显。
采用EPS转矩控制的方法在行车的时候，容易产生转向角超调，车辆存在偏出车道线的风险。
采用EPS转角控制的方法在行车的时候，EPS内部需要增加逻辑通过特定的算法(PID控制、LQR控制等)计算出EPS执行电机的助力转矩，这会导致ADAS控制器的转角指令得出->EPS执行转矩的计算延迟，不仅增加了车辆偏出车道线的风险，也增加了EPS控制方向盘转角抖动的风险。
发明内容
本发明所要解决的技术问题是，克服现有技术的不足，提供一种车辆自主驾驶控制系统及车辆横向控制方法，保证车辆行驶在满足特定条件的车道线内，安全且高效。
为了解决上述技术问题，本发明的技术方案是：
本发明提供一种车辆自主驾驶横向控制方法，它包括：
步骤S1、采集车辆摄像头输出的车道线信息和目标障碍物信息，然后采集车辆的EPS电子助力转向控制器、ESC车辆稳定系统和IMU惯性传感器输出的车辆状态信息；
步骤S2、对车道线信息、目标障碍物信息和车辆状态信息进行信号处理；
步骤S3、对驾驶员意图进行识别；
步骤S4、计算预瞄点的横向控制偏差值和车身姿态角；
步骤S5、根据预瞄点的横向控制偏差值，计算车辆期望的姿态角；
步骤S6、根据车辆期望的姿态角，计算车辆期望的姿态角控制偏差值，对车辆期望的姿态角控制偏差值进行控制，计算EPS电子助力转向控制器的期望转角；
步骤S7、根据EPS电子助力转向控制器的期望转角，计算EPS电子助力转向控制器的期望助力转矩，得到横向控制指令转矩；
步骤S8、确定横向控制功能的状态，在横向控制功能处于激活状态下，发送横向控制指令转矩至EPS电子助力转向控制器。
进一步，所述步骤S2中，对所述车道线信息进行信号处理，具体包括如下步骤：
根据摄像头识别的左侧车道线方程：
Figure SMS_3
其中，l0、l1、l2和l3均为常量；
根据摄像头识别的右侧车道线方程：
Figure SMS_4
其中，r0、r1、r2和r3均为常量；
将左右车道线的置信度、道路宽度、车道线类型和宽度信息，融合得到车道中心线方程：
Figure SMS_5
其中，c0、c1、c2和c3均为常量；
所述车道中心线方程的坐标原点位于车辆后轴中心，x轴指向车辆前进的方向，y轴指向与车辆前进方向垂直的侧向平面。
进一步，所述步骤S2中，对所述车辆状态信息进行信号处理，具体包括如下步骤：
对车速信号和横摆角速度信号进行滤波处理，同时估算车辆的质心侧偏角、车辆行驶的道路状况，所述车辆行驶的道路状况包括车辆是否在沿着有坡道的道路行驶和路面的附着系数。
进一步，所述步骤S4中，计算预瞄点的横向控制偏差值和车身姿态角，具体包括如下步骤：
根据车辆不同的运动场景，计算不同场景下的预瞄点的横向控制偏差值
Figure SMS_6
，所述预瞄点的横向控制偏差值/>
Figure SMS_7
的计算公式如下：
Figure SMS_8
；
其中，Yp为预瞄点P处的横向位移，
Figure SMS_9
是车辆的纵向速度，/>
Figure SMS_10
是车辆运动的横摆角速度，/>
Figure SMS_11
是质心侧偏角，/>
Figure SMS_12
是车辆预瞄控制纵向距离，预瞄时间设置为/>
Figure SMS_13
。
进一步，若车道线为曲线，车辆沿直线运行，域控制器的MCU模块计算得到车辆的运动轨迹为PP0，预瞄点为P，预瞄点P处的横向位移为PA，然后计算t0时刻预瞄点P处的横向位移PA，所述t0时刻预瞄点P处的横向位移PA的计算方法如下：
首先，计算在t0 时刻车辆处于P0点处相对于车道线的横向位移，车身的横向误差为直线段
Figure SMS_14
，此时/>
Figure SMS_15
；
车辆中心到车道左边界的横向位置为：
Figure SMS_16
其中，约定左侧横向位置为负，
Figure SMS_17
；
车辆中心到车道右边界的横向位置为：
Figure SMS_18
其中，约定右侧横向位置为正，
Figure SMS_19
；
所以，车辆在车身坐标原点
Figure SMS_20
处的横向位移为：
Figure SMS_21
；
然后，计算t0时刻预瞄点P处的横向位移
Figure SMS_22
，此时/>
Figure SMS_23
；
设车辆运行车速为Vx，车辆运行方向为沿着P0P直线运动，预瞄点P处的横向位移
Figure SMS_24
为：/>
Figure SMS_25
；
由于
Figure SMS_26
，因此，车辆在预瞄点P处的横向控制偏差/>
Figure SMS_27
为：
Figure SMS_28
；
最后，计算车辆在预瞄点P处的车辆姿态角，预瞄点P处的车辆姿态角
Figure SMS_29
的计算方法如下：
在P0处车辆姿态角为车道中心线yc在坐标轴x=0处的C点切线方向和x轴的夹角，此时在车辆质心处的车身航向角
Figure SMS_30
为：
Figure SMS_31
；
在
Figure SMS_32
中，OC是车道中心线在C点的法向量方向，根据三角形的内外角关系，得出预瞄点P处的车辆姿态角/>
Figure SMS_33
为：
Figure SMS_34
其中，
Figure SMS_35
；
若车道线曲率变化小于0.01，则圆弧AB近似为
Figure SMS_36
，所以/>
Figure SMS_37
；
预瞄点P处道路的曲率为：
Figure SMS_38
其中，/>
Figure SMS_39
是预瞄点P处的道路曲率；
道路的曲率变化率在预瞄时间段tp内为常数
Figure SMS_40
，将圆弧AC的长度近似为直线/>
Figure SMS_41
，预瞄点P处的道路曲率/>
Figure SMS_42
为：
Figure SMS_43
；
在t0时刻，车道中心线yc在坐标轴x=0处的曲率
Figure SMS_44
；
则预瞄点P处的车身姿态角
Figure SMS_45
为：/>
Figure SMS_46
；
若车道线为直线，车辆的行驶方向沿x轴，域控制器的MCU模块计算得到车辆的运动轨迹为P0D，预瞄点为D；
预瞄点D处的横向位移为AD，然后计算t0时刻预瞄点D处的横向位移AD，所述t0时刻预瞄点D处的横向位移AD的计算方法如下：
首先，计算t0时刻车辆处于坐标原点处的横向误差
Figure SMS_47
，t0时刻车辆相对于车道线的航向角/>
Figure SMS_48
，在预瞄时间t p内，车辆保持车速Vx前进，质心侧偏角/>
Figure SMS_49
；
在t0时刻，直线
Figure SMS_50
为此时车辆在坐标原点/>
Figure SMS_51
处的横向误差/>
Figure SMS_52
，车辆在坐标原点/>
Figure SMS_53
处的横向误差/>
Figure SMS_54
的计算公式为：/>
Figure SMS_55
；
其中，
Figure SMS_56
为车辆在原点/>
Figure SMS_57
处到车道线中心的横向位移，此时x=0，根据左侧车道线方程和右侧车道线方程计算车辆在坐标原点/>
Figure SMS_58
处的横向误差/>
Figure SMS_59
，得到：
Figure SMS_60
；
然后，计算车辆在预瞄时刻点
Figure SMS_61
处的横向控制偏差/>
Figure SMS_62
为：
Figure SMS_63
；
其中，
Figure SMS_64
是域控制器的MCU模块计算得出的车辆不发生侧偏情况下预瞄时刻横向位移，车辆沿x轴行驶到预瞄时刻P点和车道中心线yc的距离为直线PA，所述直线PA为/>
Figure SMS_65
，此时/>
Figure SMS_66
，代入左侧车道线方程和右侧车道线方程得到：
Figure SMS_67
；
Figure SMS_68
；
Figure SMS_69
；
车辆实际沿着P0D行驶，在
Figure SMS_70
之中，P0P垂直于PD，所以PD的表达式为：
Figure SMS_71
；
将PD的表达式代入车辆在预瞄时刻点
Figure SMS_72
处的横向控制偏差/>
Figure SMS_73
的公式中，得到：/>
Figure SMS_74
；
最后，计算车辆在预瞄时刻点
Figure SMS_75
处的车身姿态角/>
Figure SMS_76
：/>
Figure SMS_77
；
若车道线为直线，车辆做曲线行驶，域控制器的MCU模块计算得到车辆的运动轨迹为P0D，预瞄点为D；
首先，计算车辆在坐标当前点P0处的横向误差
Figure SMS_78
，横向误差/>
Figure SMS_79
的计算方法是：/>
Figure SMS_80
；
然后，计算车辆在预瞄点D处的横向控制偏差
Figure SMS_81
为：
Figure SMS_82
；
其中，
Figure SMS_83
；
Figure SMS_84
；
根据匀速圆周运动的运动学关系：
Figure SMS_85
；
所以PD的表达式为：
Figure SMS_86
；
将PD的表达式代入车辆在预瞄点D处的横向控制偏差
Figure SMS_87
的公式中，得到：
Figure SMS_88
；
由于车辆质心侧偏角
Figure SMS_89
忽略不记，将车辆在预瞄点D处的横向控制偏差/>
Figure SMS_90
的公式简化为：/>
Figure SMS_91
；
最后，车辆做直线运动，道路在预瞄点D处的偏航角
Figure SMS_92
满足如下公式：
Figure SMS_93
其中， />
Figure SMS_94
；
计算车辆在预瞄点D处的车身姿态角
Figure SMS_95
：/>
Figure SMS_96
。
进一步，所述步骤S5中，根据预瞄点的横向控制偏差值，计算车辆期望的姿态角，具体包括如下步骤：
步骤S51、计算横向位置偏差
Figure SMS_97
：/>
Figure SMS_98
Figure SMS_99
；
其中，
Figure SMS_100
的计算可以根据横向控制的敏感度因子，敏感度因子通常可以通过HMI车辆仪表进行档位设置，譬如敏感度1~4级，分别对应于车道宽度B的百分比δ，一种简单可行的敏感因子1级对应于/>
Figure SMS_101
，第i级对应于/>
Figure SMS_102
，其中i=2、3、4，
Figure SMS_103
，根据实际情况可调。如果敏感因子为1级， />
Figure SMS_104
这种情况下，对应于车辆的车道线居中保持功能，相当于让车辆的目标轨迹处于车道的中心线。
步骤S52、对横向控制偏差值进行控制，计算得出车辆期望的姿态角
Figure SMS_105
：
Figure SMS_106
；
步骤S53、计算车辆期望的姿态角的控制补偿部分
Figure SMS_107
：
由于车辆在预瞄点处期望的车身姿态角和预瞄处的目标航迹的航向角一致：
Figure SMS_108
；
如果驾驶员的需求是车道线居中的情况下，那么：
Figure SMS_109
；
如果驾驶员的需求是车道线保持功能的情况下，那么：
Figure SMS_110
；
其中，
Figure SMS_111
表示横向位移的正负号，/>
Figure SMS_112
为标定常量；
步骤S54、对车辆期望的姿态角
Figure SMS_113
进行补偿：/>
Figure SMS_114
；
步骤S55、对车辆期望的姿态角
Figure SMS_115
进行修正，计算得出最终的车辆期望的姿态角/>
Figure SMS_116
。
进一步，所述步骤S6中，根据车辆期望的姿态角，计算车辆期望的姿态角控制偏差值，对车辆期望的姿态角控制偏差值进行控制，计算EPS电子助力转向控制器的期望转角，具体包括如下步骤：
步骤S61、计算车辆期望的姿态角控制偏差值
Figure SMS_117
：/>
Figure SMS_118
其中，
Figure SMS_119
，/>
Figure SMS_120
预瞄点处的车身姿态角/>
Figure SMS_121
；
步骤S62、对姿态角控制偏差值
Figure SMS_122
进行反馈控制：
采用PID控制算法对姿态角控制偏差值
Figure SMS_123
进行反馈控制，计算方法如下：
Figure SMS_124
；
步骤S63、对车辆期望的姿态角
Figure SMS_125
进行前馈补偿：
采用基于车道线曲率补偿方法对车辆期望的姿态角
Figure SMS_126
进行前馈补偿，计算方法如下：/>
Figure SMS_127
Figure SMS_128
其中，R是车道线的曲率半径，L是车辆的轮距，
Figure SMS_129
是车辆的纵向速度；/>
Figure SMS_130
是车辆的稳定性系数，/>
Figure SMS_131
表示车辆不足转向，/>
Figure SMS_132
表示车辆为中性转向，/>
Figure SMS_133
表示车辆为过度转向；
步骤S64、计算带前馈补偿的EPS电子助力转向控制器的期望转角
Figure SMS_134
：
Figure SMS_135
其中，参数
Figure SMS_136
是前馈补偿系数；
步骤S65、计算最终的EPS电子助力转向控制器的期望转角
Figure SMS_137
：
将所述步骤S64之中计算得到的
Figure SMS_138
，进行上下限幅，得到期望转角 />
Figure SMS_139
。
进一步，所述步骤S7中，根据EPS电子助力转向控制器的期望转角，计算EPS电子助力转向控制器的期望助力转矩，得到横向控制指令转矩，具体包括如下步骤：
步骤S71、计算EPS电子助力转向控制器的期望转角
Figure SMS_140
和实际转角的差值，得到EPS电子助力转向控制器的控制偏差/>
Figure SMS_141
：
Figure SMS_142
；
步骤S72、对EPS电子助力转向控制器的控制偏差
Figure SMS_143
进行控制（PID控制、LQR控制、滑膜控制等），得出EPS电子助力转向控制器的期望转矩/>
Figure SMS_144
；
步骤S73、根据方向盘反馈转角或者反馈转矩的变化情况，对EPS电子助力转向控制器的请求转矩注入谐波补偿转矩，抑制EPS电子助力转向控制器的助力电机抖动，通过计算得到谐波补偿转矩
Figure SMS_145
；
步骤S74、计算带谐波补偿的EPS电子助力转向控制器的期望助力转矩
Figure SMS_146
：
Figure SMS_147
；
步骤S75、对
Figure SMS_148
做上下限值，得到横向控制指令转矩/>
Figure SMS_149
。
采用了上述技术方案，本发明具有以下的有益效果：
1、本发明能够利用摄像头以及其他车载传感器获取车辆相对于车道线的位置信息、方向信息以及车身状态信息，并根据驾驶员操作状态判断驾驶员意图。当车辆在非驾驶员主观意图的情况下偏离车道中心线时，系统对车辆进行横向干预，辅助驾驶员将车辆保持在车道中间。
2、本发明可以使驾驶员减少转向负担，提高驾驶舒适性，可以在一些情况下让车辆保持在车道中间行驶，在驾驶员脱手时会被系统警告，驾驶员主动变道的状况也会被检查并对功能进行抑制。
3、本发明可以应用于不同类型（实线、虚线和点状线）和颜色（白色、黄色、橙色和蓝色）的道路交通边线；也可以应用于没有车道线的路沿。
附图说明
图1为本发明的一种车辆自主驾驶控制系统的原理框图；
图2为本发明的ADAS域控制器的原理框图；
图3为本发明的车辆运动场景1的示意图；
图4为本发明的车辆运动场景2的示意图；
图5为本发明的车辆运动场景3的示意图；
图6为本发明的一种车辆自主驾驶横向控制方法的流程图。
具体实施方式
为了使本发明的内容更容易被清楚地理解，下面根据具体实施例并结合附图，对本发明作进一步详细的说明。
实施例一
如图1所示，本实施例提供一种车辆自主驾驶控制系统，它包括摄像头、ESC车辆稳定系统、EMS发动机控制系统、TCM变速箱、BCM车身控制器、EPS电子助力转向控制器、ADAS域控制器和HMI车辆仪表；
摄像头用于对车辆外部环境信息进行识别并将外部环境信息送至ADAS域控制器；
ADAS域控制器用于进行车辆的横纵向融合控制（譬如车道保持功能）；
ESC车辆稳定系统用于控制车辆加减速，EMS发动机控制系统用于为车辆提供动力，TCM变速箱用于车辆换挡，BCM车身控制器用于将车身状态传送至ACC功能控制器，EPS电子助力转向控制器用于为方向盘提供转向助力；
HMI车辆仪表用于显示ADAS功能（譬如LKA/ACC）请求、开启状态以及设定的车速等相关信息。
如图2所示，本实施例的ADAS域控制器包括：
SOC模块，是指用于图像处理、带人工神经网络处理算法的逻辑门电路一般有FPGA以及基于ARM核心的处理器。在本发明中SOC模块用于对前视、后视摄像头采集的图像进行处理，譬如车道线识别、车辆环境周围目标的识别（自车车道前方目标车辆、相邻车道目标车辆的识别等）；
MCU模块，在本发明中MCU模块用于控制整车CAN网络通讯、对超声波雷达进行激励和信号处理、运算处理ADAS横向控制算法；
IMU惯性传感器，例如陀螺仪，惯性传感器IMU用于感知车辆的运动状态，包括横向加速度ay、纵向加速度ax、横摆角速度
Figure SMS_150
等；
eMMC存储模块，指存储卡，eMMC存储模块用于存储视频信号；
Nor Flash闪存模块，Nor Flash闪存模块用于存储标定参数和运行代码；
CAN通信模块，CAN通信模块用于MCU模块和车辆执行器（包括EPS、ESC、EMS等执行器）进行通讯，然后控制车辆执行器完成相应的驱动、制动、转向等动作；
Serialier串口通讯模块，Serialier串口通讯模块用于摄像头与SOC模块之间的通讯。
实施例二
如图1所示，本实施例提供一种车辆自主驾驶横向控制方法，本方法基于实施例一中车辆自主驾驶控制系统的硬件使用，本方法包括：
步骤S1、采集车辆摄像头输出的车道线信息和目标障碍物信息，然后采集车辆的EPS电子助力转向控制器、ESC车辆稳定系统和IMU惯性传感器输出的车辆状态信息。
步骤S2、对车道线信息、目标障碍物信息和车辆状态信息进行信号处理。
步骤S3、对驾驶员意图进行识别，譬如驾驶员脱手、驾驶员换道、驾驶员接管控制等。
步骤S4、计算预瞄点的横向控制偏差值和车身姿态角。
步骤S5、根据预瞄点的横向控制偏差值，计算车辆期望的姿态角。
步骤S6、根据车辆期望的姿态角，计算车辆期望的姿态角控制偏差值，对车辆期望的姿态角控制偏差值进行控制，计算EPS电子助力转向控制器的期望转角。
步骤S7、根据EPS电子助力转向控制器的期望转角，计算EPS电子助力转向控制器的期望助力转矩，得到横向控制指令转矩。
步骤S8、确定横向控制功能的状态，在横向控制功能处于激活状态下，通过网络发送横向控制指令转矩至EPS电子助力转向控制器。
具体地，本实施例的步骤S1中，采集车辆摄像头输出的车道线信息和目标障碍物信息，然后采集车辆的EPS电子助力转向控制器、ESC车辆稳定系统和IMU惯性传感器输出的车辆状态信息，具体包括如下步骤：
通过网络采集车辆摄像头输出的车道线信息和目标障碍物信息，如图2所示，通过SOC模块获取摄像头发送的视频信号并通过SOC模块内的图像处理算法识别车道线和目标障碍物。并选择合适的坐标原点、建立车道线方程、计算相应的目标障碍物的坐标信息以及目标障碍物识别的置信度。为了增加目标障碍物识别的准确性，本系统还采用雷达来获取目标障碍物。如图2所示，通过网络，获取雷达传感器的目标障碍物信息，目标障碍物信息包括目标的距离信息、速度信息等。然后通过网络采集EPS电子助力转向控制器、ESC车辆稳定系统和IMU惯性传感器输出的车辆状态信息，车辆状态信息包括车速、车身横摆角速度、车身横向加速度、制动、驱动系统状态信息，具体实施过程如下：
1、雷达和视觉目标的坐标转换
在获得了准确的车道线信息、视觉目标信息、雷达目标信息、车辆的状态信息情况下，就需要对这些信息进行处理，包括滤波、坐标转换等。
由于雷达和视觉的目标坐标不一定相同，首先需要将雷达的目标和视觉的目标进行坐标转换，建立一个统一的坐标，然后才能对雷达和视觉目标进行统一的分析和处理。
2、雷达和视觉目标的数据融合
由于在一些情况下，比如晚上、或者大雾天气、或者有逆光的特定场景，导致摄像头感知的信息的精确性变差。然而在另外一些情况下，比如暴雨天气，或者存在电磁干扰的区域，雷达感知的目标信息的可靠性也会比较差。为了提高ADAS域控制器在全天候情况下的可靠性，本发明通过数据融合的算法（比如卡尔曼滤波、模型预测控制），将雷达和摄像头获取的目标障碍物信息，经过一系列的处理，将目标障碍物信息进行融合后，提高了目标障碍物识别的置信度。
3、雷达和视觉目标的选择
首先需要将所有的目标按车道线进行分类，挑选出本车所处车道以及相邻车道上的离本车最近的目标障碍物以及比最近的障碍物稍远的目标障碍物。
具体地，本实施例的步骤S2中，对车道线信息进行信号处理，具体包括如下步骤：
根据摄像头识别的左侧车道线方程：
Figure SMS_151
其中，l0、l1、l2和l3均为常量；
根据摄像头识别的右侧车道线方程：
Figure SMS_152
其中，r0、r1、r2和r3均为常量；
将左右车道线的置信度、道路宽度、车道线类型和宽度信息，融合得到车道中心线方程：
Figure SMS_153
其中，c0、c1、c2和c3均为常量；
车道中心线方程的坐标原点位于车辆后轴中心（如果感知系统设定坐标原点位于车身质心位置、摄像头安装位置等，那么通过坐标变化以及调整一些参数可以实现坐标位置的变换），x轴指向车辆前进的方向（单位为米），y轴指向与车辆前进方向垂直的侧向平面（这里约定右侧为正，单位为米）。
车辆横向控制的目标就是，使得车辆的行驶轨迹和车道中心线重合，使得车辆在道路中的横向偏差保持为0，并且车辆的航行方向始终和车道中心线的切线方向保持一致。
具体地，本实施例的步骤S2中，对车辆状态信息进行信号处理，具体包括如下步骤：
对车速信号和横摆角速度信号进行滤波处理，同时估算车辆的质心侧偏角、车辆行驶的道路状况，车辆行驶的道路状况包括车辆是否在沿着有坡道的道路行驶和路面的附着系数。
具体地，本实施例的步骤S4中，计算预瞄点的横向控制偏差值和车身姿态角，具体包括如下步骤：
根据车辆不同的运动场景，计算不同场景下的预瞄点的横向控制偏差值
Figure SMS_154
，预瞄点的横向控制偏差值/>
Figure SMS_155
的计算公式如下：
Figure SMS_156
；
其中，Yp为预瞄点P处的横向位移，
Figure SMS_157
是车辆的纵向速度，/>
Figure SMS_158
是车辆运动的横摆角速度（通过车辆的惯性传感器测量得到），/>
Figure SMS_159
是质心侧偏角（通过车辆的运动方程估算得到），
Figure SMS_160
是车辆预瞄控制纵向距离（一般随车速变化，/>
Figure SMS_161
,/>
Figure SMS_162
是预瞄控制提前时间点），预瞄时间设置为/>
Figure SMS_163
，通常为0.5s~2s之间根据道路曲率、车辆行驶速度等情况可调。
下面对3中车辆运动场景进行阐述：
车辆运动场景1，如图3所示，若车道线为曲线，车辆沿直线运行（车辆的横摆角速度
Figure SMS_164
），如果车辆直线行驶，质心侧偏角很小，/>
Figure SMS_165
。在这种情况下，域控制器的MCU模块计算得到车辆的运动轨迹为PP0，预瞄点为P，预瞄点P处的横向位移为PA，然后计算t0时刻预瞄点P处的横向位移PA，t0时刻预瞄点P处的横向位移PA的计算方法如下：
首先，计算在t0时刻车辆处于P0点处相对于车道线的横向位移，那么在t0处，由于在车辆质心处的车身航向角
Figure SMS_166
很小，/>
Figure SMS_167
，车身的横向误差为直线段 />
Figure SMS_168
Figure SMS_169
，此时/>
Figure SMS_170
；
车辆中心到车道左边界的横向位置为：
Figure SMS_171
其中，约定左侧横向位置为负，/>
Figure SMS_172
；
车辆中心到车道右边界的横向位置为：
Figure SMS_173
其中，约定右侧横向位置为正， />
Figure SMS_174
；
所以，车辆在车身坐标原点
Figure SMS_175
处的横向位移为：/>
Figure SMS_176
；
然后，计算t0时刻预瞄点P处的横向位移
Figure SMS_177
，此时/>
Figure SMS_178
；
如图3所示，设车辆运行车速为Vx，车辆运行方向为沿着P0P直线运动，预瞄点P处的横向位移
Figure SMS_179
为：/>
Figure SMS_180
；
由于
Figure SMS_181
，因此，车辆在预瞄点P处的横向控制偏差/>
Figure SMS_182
为：
Figure SMS_183
；
最后，计算车辆在预瞄点P处的车辆姿态角，如图3所示，预瞄点P处的车辆姿态角
Figure SMS_184
的计算方法如下：
在P0处车辆姿态角为车道中心线yc在坐标轴x=0处的C点切线方向和x轴的夹角（约定夹角方向偏右侧为正），此时在车辆质心处的车身航向角
Figure SMS_185
为：
Figure SMS_186
；
在
Figure SMS_187
中，OC是车道中心线在C点的法向量方向，根据三角形的内外角关系，得出预瞄点P处的车辆姿态角/>
Figure SMS_188
为：/>
Figure SMS_189
其中，
Figure SMS_190
若车道线曲率变化小于0.01，则圆弧AB近似为
Figure SMS_191
，所以/>
Figure SMS_192
；
预瞄点P处道路的曲率为：
Figure SMS_193
其中，/>
Figure SMS_194
是预瞄点P处的道路曲率；
根据拟合的车道线方程，在预瞄时间内道路的曲率变化率近似为常量，道路的曲率变化率在预瞄时间段tp内为常数
Figure SMS_195
，同时为了简化计算，将圆弧AC的长度近似为直线/>
Figure SMS_196
，预瞄点P处的道路曲率/>
Figure SMS_197
为：
Figure SMS_198
；
在t0时刻，车道中心线yc在坐标轴x=0处的曲率
Figure SMS_199
；
则预瞄点P处的车身姿态角
Figure SMS_200
为：/>
Figure SMS_201
。
总结，根据上面分析的预瞄控制结果（提前控制时间是tp），车辆按照当前时刻t0的方向行驶，在tp之后横向误差和航向角误差都存在扩大的趋势，预瞄控制的优点在于，提前预测了这种横向误差和航向角误差，并且及时进行了干预，这弥补了车辆的执行机构的响应滞后的特点，这也符合驾驶员在车辆行驶的过程中都存在提前控制车辆转向的动作。
由此，车辆基于预瞄的横向自主驾驶的精度和稳定性，依赖于横向误差和偏航角误差的预测精度，本发明通过理论分析和实践，创立了精确计算横向误差和偏航角误差的方法。
车辆运动场景2，如图4所示，若车道线为直线，车辆的行驶方向沿x轴，由于车辆质心侧偏角
Figure SMS_202
的存在（通常由于侧向风的存在、或者车辆运行在斜坡上、或者车辆沿着一定的曲率行驶等，会使得质心侧偏角不等于0，这里约定/>
Figure SMS_203
角偏向右方为正），域控制器的MCU模块计算得到车辆的运动轨迹为P0D，预瞄点为D；域控制器的MCU模块可以预测得出车辆的实际运行轨迹P0D和期望运行轨迹，期望运行轨迹即为车道中心线yc，在这种情况下，MCU模块预测到在预瞄时间tp后，车辆将运动到D点，所以D点就是预瞄点。
在这样的场景下，车辆的横摆角速度
Figure SMS_204
很小，在此忽略/>
Figure SMS_205
的影响。/>
Figure SMS_206
和/>
Figure SMS_207
角比较小，但是对于横向位置的影响，下面的算法主要描叙/>
Figure SMS_208
角对于横向误差的影响。
预瞄点D处的横向位移为AD，然后计算t0时刻预瞄点D处的横向位移AD，t0时刻预瞄点D处的横向位移AD的计算方法如下：
首先，计算t0时刻车辆处于坐标原点处的横向误差
Figure SMS_209
，t0时刻车辆相对于车道线的航向角/>
Figure SMS_210
，在预瞄时间t p内，车辆保持车速Vx前进，质心侧偏角/>
Figure SMS_211
（约定侧偏角往x轴坐标右偏为正值）；
在t0时刻，直线
Figure SMS_212
为此时车辆在坐标原点/>
Figure SMS_213
处的横向误差/>
Figure SMS_214
，车辆在坐标原点/>
Figure SMS_215
处的横向误差/>
Figure SMS_216
的计算公式为：
Figure SMS_217
；
其中，
Figure SMS_218
为车辆在原点/>
Figure SMS_219
处到车道线中心的横向位移，此时x=0，根据左侧车道线方程和右侧车道线方程计算车辆在坐标原点/>
Figure SMS_220
处的横向误差/>
Figure SMS_221
，得到：
Figure SMS_222
；
然后，计算车辆在预瞄时刻点
Figure SMS_223
处的横向控制偏差/>
Figure SMS_224
为：
Figure SMS_225
；
其中，
Figure SMS_226
是域控制器的MCU模块计算得出的车辆不发生侧偏情况下预瞄时刻横向位移，车道线方程是t0时刻建立的，车辆沿x轴行驶到预瞄时刻P点和车道中心线yc的距离为直线PA，直线PA为/>
Figure SMS_227
，此时/>
Figure SMS_228
，代入左侧车道线方程和右侧车道线方程得到：
Figure SMS_229
；
Figure SMS_230
；
Figure SMS_231
；
由于车辆的质心侧偏角β较大，不能忽略，如图4所示，导致车辆实际沿着P0D行驶，在
Figure SMS_232
之中，P0P垂直于PD，所以PD的表达式为：
Figure SMS_233
；
将PD的表达式代入车辆在预瞄时刻点
Figure SMS_234
处的横向控制偏差/>
Figure SMS_235
的公式中，得到：
Figure SMS_236
；
最后，计算车辆在预瞄时刻点P处的车身姿态角
Figure SMS_237
：
Figure SMS_238
。
车辆运动场景3，如图5所示，若车道线为直线，车辆做曲线行驶，考虑车辆的横摆角速度对于横向运动的影响，假设车辆的运动瞬心是点O，车辆绕O点做横摆角速度
Figure SMS_239
的匀速圆周运动，且曲率半径为R0。域控制器的MCU模块计算得到车辆的运动轨迹为P0D，预瞄点为D；域控制器的MCU模块可以预测得出得出车辆的实际运行轨迹P0D和期望运行轨迹，期望运行轨迹即为车道中心线yc，在这种情况下，MCU模块预测到在预瞄时间tp后，车辆将运动到点D，所以D点就是预瞄点。
首先，计算车辆在坐标当前点P0处的横向误差
Figure SMS_240
，横向误差/>
Figure SMS_241
的计算方法是：
Figure SMS_242
；/>
然后，计算车辆在预瞄点D处的横向控制偏差
Figure SMS_243
为：
Figure SMS_244
；
其中，
Figure SMS_245
；
由于预瞄时间较小，而曲率半径
Figure SMS_246
很多，所以/>
Figure SMS_247
很小，/>
Figure SMS_248
；
根据匀速圆周运动的运动学关系：
Figure SMS_249
；
所以PD的表达式为：
Figure SMS_250
；
将PD的表达式代入车辆在预瞄点D处的横向控制偏差
Figure SMS_251
的公式中，得到：
Figure SMS_252
；
由于车辆质心侧偏角
Figure SMS_253
很小，可以忽略不记，车辆在预瞄点D处的横向控制偏差
Figure SMS_254
的公式可以简化为：
Figure SMS_255
；
最后，根据图5的几何关系可知，如果车辆做直线运动，道路在预瞄点D处的偏航角
Figure SMS_256
满足如下公式：/>
Figure SMS_257
其中，/>
Figure SMS_258
；
计算车辆在预瞄点D处的车身姿态角
Figure SMS_259
：
Figure SMS_260
。
具体地，本实施例的步骤S5中，根据预瞄点的横向控制偏差值，计算车辆期望的姿态角，具体包括如下步骤：
步骤S51、计算横向位置偏差
Figure SMS_261
：
Figure SMS_262
Figure SMS_263
；
其中，
Figure SMS_264
的计算可以根据横向控制的敏感度因子，敏感度因子通常可以通过HMI车辆仪表进行档位设置，譬如敏感度1~4级，分别对应于车道宽度B的百分比δ，一种简单可行的敏感因子1级对应于 />
Figure SMS_265
，第i级对应于 />
Figure SMS_266
，其中i=2、3、4，
Figure SMS_267
，根据实际情况可调。如果敏感因子为1级，/>
Figure SMS_268
这种情况下，对应于车辆的车道线居中保持功能，相当于让车辆的目标轨迹处于车道的中心线。
步骤S52、对横向控制偏差值进行控制，常用的方法有PID控制、滑膜控制、MPC控制、人工神经网络控制、LQR控制等，这里采用PID控制算法计算得出车辆期望的姿态角
Figure SMS_269
：/>
Figure SMS_270
；
步骤S53、计算车辆期望的姿态角的控制补偿部分
Figure SMS_271
：
由于车辆在预瞄点处期望的车身姿态角和预瞄处的目标航迹的航向角一致：
Figure SMS_272
；
如果驾驶员的需求是车道线居中的情况下，那么：
Figure SMS_273
；
如果驾驶员的需求是车道线保持功能的情况下，那么：
Figure SMS_274
；
其中，
Figure SMS_275
表示横向位移的正负号， />
Figure SMS_276
为标定常量；
步骤S54、对车辆期望的姿态角
Figure SMS_277
进行补偿：/>
Figure SMS_278
；
步骤S55、对车辆期望的姿态角
Figure SMS_279
进行修正，计算得出最终的车辆期望的姿态角/>
Figure SMS_280
，常见的修正包括阻尼补偿修正、敏感度因子修正等。
具体地，本实施例的步骤S6中，根据车辆期望的姿态角
Figure SMS_281
，计算车辆期望的姿态角控制偏差值/>
Figure SMS_282
，对车辆期望的姿态角控制偏差值/>
Figure SMS_283
进行控制，计算EPS电子助力转向控制器的期望转角/>
Figure SMS_284
，具体包括如下步骤：
步骤S61、计算车辆期望的姿态角控制偏差值
Figure SMS_285
：
Figure SMS_286
其中，
Figure SMS_287
，/>
Figure SMS_288
预瞄点处的车身姿态角/>
Figure SMS_289
；
步骤S62、对姿态角控制偏差值
Figure SMS_290
进行反馈控制：
典型的控制算法有PID控制、LQR控制、滑膜控制、Bang-Bang控制等，本发明采用PID控制算法对姿态角控制偏差值
Figure SMS_291
进行反馈控制，计算方法如下：
Figure SMS_292
；
步骤S63、对车辆期望的姿态角
Figure SMS_293
进行前馈补偿：
常见的前馈补偿方法有基于横摆角速度进行补偿、基于侧向加速度进行补偿、基于车道线曲率补偿等方法，本发明采用基于车道线曲率补偿方法对车辆期望的姿态角
Figure SMS_294
进行前馈补偿，计算方法如下：/>
Figure SMS_295
Figure SMS_296
其中，R是车道线的曲率半径，L是车辆的轮距，
Figure SMS_297
是车辆的纵向速度；/>
Figure SMS_298
是车辆的稳定性系数，/>
Figure SMS_299
表示车辆不足转向，/>
Figure SMS_300
表示车辆为中性转向，/>
Figure SMS_301
表示车辆为过度转向；
步骤S64、计算带前馈补偿的EPS电子助力转向控制器的期望转角
Figure SMS_302
：
Figure SMS_303
其中，参数/>
Figure SMS_304
是前馈补偿系数；
步骤S65、计算最终的EPS电子助力转向控制器的期望转角
Figure SMS_305
：
将步骤S64之中计算得到的
Figure SMS_306
，进行上下限幅，得到期望转角/>
Figure SMS_307
，避免/>
Figure SMS_308
超出了上下限值，防止车辆转向角度过大，最终车辆驶出了车道线。
方向盘目标转角的上限
Figure SMS_309
（取正值）和车辆的行驶速度以及地面附着系数相关。低速情况下，方向盘允许的转向角大；反之，高速情况下，方向盘允许的转向角小。在湿滑路面或者冰雪路面，路面能提供的侧向摩擦力小，使得车辆容许的侧向加速度小，从而使得/>
Figure SMS_310
比附着良好的沥青路面小。
对于方向盘目标转角的下限
Figure SMS_311
，一般情况下/>
Figure SMS_312
。
具体地，本实施例的步骤S7中，根据EPS电子助力转向控制器的期望转角
Figure SMS_313
，计算EPS电子助力转向控制器的期望助力转矩/>
Figure SMS_314
，得到横向控制指令转矩/>
Figure SMS_315
，具体包括如下步骤：
步骤S71、计算EPS电子助力转向控制器的期望转角
Figure SMS_316
和实际转角的差值，得到EPS电子助力转向控制器的控制偏差/>
Figure SMS_317
：
Figure SMS_318
；
步骤S72、对EPS电子助力转向控制器的控制偏差
Figure SMS_319
进行控制（PID控制、LQR控制、滑膜控制等），得出EPS电子助力转向控制器的期望转矩/>
Figure SMS_320
；
步骤S73、根据方向盘反馈转角或者反馈转矩的变化情况，对EPS电子助力转向控制器的请求转矩注入谐波补偿转矩，抑制EPS电子助力转向控制器的助力电机抖动，通过计算得到谐波补偿转矩
Figure SMS_321
；
步骤S74、计算带谐波补偿的EPS电子助力转向控制器的期望助力转矩
Figure SMS_322
：
Figure SMS_323
；
步骤S75、对
Figure SMS_324
做上下限值，得到横向控制指令转矩/>
Figure SMS_325
。/>
具体地，本实施例的步骤S8中，确定横向控制功能的关闭（off）、就绪（Stand-by）、激活（Activate）、故障（Failure）状态，在横向控制功能处于激活（Activate）状态下，通过网络发送横向控制指令转矩至EPS电子助力转向控制器。
以上所述的具体实施例，对本发明解决的技术问题、技术方案和有益效果进行了进一步详细说明，所应理解的是，以上所述仅为本发明的具体实施例而已，并不用于限制本发明，凡在本发明的精神和原则之内，所做的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (6)

1.一种车辆自主驾驶横向控制方法，其特征在于，它包括：
步骤S1、采集车辆摄像头输出的车道线信息和目标障碍物信息，然后采集车辆的EPS电子助力转向控制器、ESC车辆稳定系统和IMU惯性传感器输出的车辆状态信息；
步骤S2、对车道线信息、目标障碍物信息和车辆状态信息进行信号处理；
步骤S3、对驾驶员意图进行识别；
步骤S4、计算预瞄点的横向控制偏差值和车身姿态角，具体包括如下步骤：
根据车辆不同的运动场景，计算不同场景下的预瞄点的横向控制偏差值
Figure QLYQS_1
，所述预瞄点的横向控制偏差值/>
Figure QLYQS_2
的计算公式如下：
Figure QLYQS_3
；
其中，Yp为预瞄点P处的横向位移，
Figure QLYQS_4
是车辆的纵向速度，/>
Figure QLYQS_5
是车辆运动的横摆角速度，
Figure QLYQS_6
是质心侧偏角，/>
Figure QLYQS_7
是车辆预瞄控制纵向距离，预瞄时间设置为/>
Figure QLYQS_8
；
若车道线为曲线，车辆沿直线运行，域控制器的MCU模块计算得到车辆的运动轨迹为PP0，预瞄点为P，预瞄点P处的横向位移为PA，然后计算t0时刻预瞄点P处的横向位移PA，所述t0时刻预瞄点P处的横向位移PA的计算方法如下：
首先，计算在t0时刻车辆处于P0点处相对于车道线的横向位移，车身的横向误差为直线段
Figure QLYQS_9
，此时/>
Figure QLYQS_10
；
车辆中心到车道左边界的横向位置为：
Figure QLYQS_11
，
其中，约定左侧横向位置为负，
Figure QLYQS_12
；
车辆中心到车道右边界的横向位置为：
Figure QLYQS_13
，
其中，约定右侧横向位置为正，
Figure QLYQS_14
；
所以，车辆在车身坐标原点
Figure QLYQS_15
处的横向位移为：
Figure QLYQS_16
；
然后，计算t0时刻预瞄点P处的横向位移
Figure QLYQS_17
，此时/>
Figure QLYQS_18
；
设车辆运行车速为Vx，车辆运行方向为沿着P0P直线运动，预瞄点P处的横向位移
Figure QLYQS_19
为：
Figure QLYQS_20
；
由于
Figure QLYQS_21
，因此，车辆在预瞄点P处的横向控制偏差/>
Figure QLYQS_22
为：
Figure QLYQS_23
；
最后，计算车辆在预瞄点P处的车辆姿态角，预瞄点P处的车辆姿态角
Figure QLYQS_24
的计算方法如下：
在P0处车辆姿态角为车道中心线yc在坐标轴x=0处的C点切线方向和x轴的夹角，此时在车辆质心处的车身航向角
Figure QLYQS_25
为：
Figure QLYQS_26
；
在
Figure QLYQS_27
中，OC是车道中心线在C点的法向量方向，根据三角形的内外角关系，得出预瞄点P处的车辆姿态角/>
Figure QLYQS_28
为：
Figure QLYQS_29
，
其中，
Figure QLYQS_30
；
若车道线曲率变化小于0.01，则圆弧AB近似为
Figure QLYQS_31
，所以/>
Figure QLYQS_32
；
预瞄点P处道路的曲率为：
Figure QLYQS_33
，
其中，
Figure QLYQS_34
是预瞄点P处的道路曲率；
道路的曲率变化率在预瞄时间段tp内为常数
Figure QLYQS_35
，将圆弧AC的长度近似为直线
Figure QLYQS_36
，预瞄点P处的道路曲率/>
Figure QLYQS_37
为：
Figure QLYQS_38
；
在t0时刻，车道中心线yc在坐标轴x=0处的曲率
Figure QLYQS_39
；
则预瞄点P处的车身姿态角
Figure QLYQS_40
为：
Figure QLYQS_41
；
若车道线为直线，车辆的行驶方向沿x轴，域控制器的MCU模块计算得到车辆的运动轨迹为P0D，预瞄点为D；
预瞄点D处的横向位移为AD，然后计算t0时刻预瞄点D处的横向位移AD，所述t0时刻预瞄点D处的横向位移AD的计算方法如下：
首先，计算t0时刻车辆处于坐标原点处的横向误差
Figure QLYQS_42
，t0时刻车辆相对于车道线的航向角/>
Figure QLYQS_43
，在预瞄时间tp内，车辆保持车速Vx前进，质心侧偏角/>
Figure QLYQS_44
；
在t0时刻，直线
Figure QLYQS_45
为此时车辆在坐标原点/>
Figure QLYQS_46
处的横向误差/>
Figure QLYQS_47
，车辆在坐标原点
Figure QLYQS_48
处的横向误差/>
Figure QLYQS_49
的计算公式为：
Figure QLYQS_50
；
其中，
Figure QLYQS_51
为车辆在原点/>
Figure QLYQS_52
处到车道线中心的横向位移，此时x=0，根据左侧车道线方程和右侧车道线方程计算车辆在坐标原点/>
Figure QLYQS_53
处的横向误差/>
Figure QLYQS_54
，得到：
Figure QLYQS_55
；
然后，计算车辆在预瞄时刻点
Figure QLYQS_56
处的横向控制偏差/>
Figure QLYQS_57
为：
Figure QLYQS_58
；
其中，
Figure QLYQS_59
是域控制器的MCU模块计算得出的车辆不发生侧偏情况下预瞄时刻横向位移，车辆沿x轴行驶到预瞄时刻P点和车道中心线yc的距离为直线PA，所述直线PA为/>
Figure QLYQS_60
，此时
Figure QLYQS_61
，代入左侧车道线方程和右侧车道线方程得到：
Figure QLYQS_62
；
Figure QLYQS_63
；
Figure QLYQS_64
；
由于车辆的质心侧偏角
Figure QLYQS_65
较大，不能忽略，车辆实际沿着P0D行驶，在/>
Figure QLYQS_66
之中，P0P垂直于PD，所以PD的表达式为：/>
Figure QLYQS_67
；
将PD的表达式代入车辆在预瞄时刻点
Figure QLYQS_68
处的横向控制偏差/>
Figure QLYQS_69
的公式中，得到：
Figure QLYQS_70
；
最后，计算车辆在预瞄时刻点
Figure QLYQS_71
处的车身姿态角/>
Figure QLYQS_72
：
Figure QLYQS_73
；
若车道线为直线，车辆做曲线行驶，
域控制器的MCU模块计算得到车辆的运动轨迹为P0D，预瞄点为D；
首先，计算车辆在坐标当前点P0处的横向误差
Figure QLYQS_74
，横向误差/>
Figure QLYQS_75
的计算方法是：
Figure QLYQS_76
；
然后，计算车辆在预瞄点D处的横向控制偏差
Figure QLYQS_77
为：
Figure QLYQS_78
；
其中，
Figure QLYQS_79
；
Figure QLYQS_80
；
根据匀速圆周运动的运动学关系：
Figure QLYQS_81
；
所以PD的表达式为：
Figure QLYQS_82
；
将PD的表达式代入车辆在预瞄点D处的横向控制偏差
Figure QLYQS_83
的公式中，得到：
Figure QLYQS_84
；
由于此时车辆质心侧偏角
Figure QLYQS_85
忽略不记，将车辆在预瞄点D处的横向控制偏差/>
Figure QLYQS_86
的公式简化为：
Figure QLYQS_87
；
最后，车辆做直线运动，道路在预瞄点D处的偏航角
Figure QLYQS_88
满足如下公式：
Figure QLYQS_89
，
其中，
Figure QLYQS_90
；
计算车辆在预瞄点D处的车身姿态角
Figure QLYQS_91
：
Figure QLYQS_92
；
步骤S5、根据预瞄点的横向控制偏差值，计算车辆期望的姿态角；
步骤S6、根据车辆期望的姿态角，计算车辆期望的姿态角控制偏差值，对车辆期望的姿态角控制偏差值进行控制，计算EPS电子助力转向控制器的期望转角；
步骤S7、根据EPS电子助力转向控制器的期望转角，计算EPS电子助力转向控制器的期望助力转矩，得到横向控制指令转矩；
步骤S8、确定横向控制功能的状态，在横向控制功能处于激活状态下，发送横向控制指令转矩至EPS电子助力转向控制器。
2.根据权利要求1所述的车辆自主驾驶横向控制方法，其特征在于，所述步骤S2中，对所述车道线信息进行信号处理，具体包括如下步骤：
根据摄像头识别的左侧车道线方程：
Figure QLYQS_93
，
其中，l0、l1、l2和l3均为常量；
根据摄像头识别的右侧车道线方程：
Figure QLYQS_94
，
其中，r0、r1、r2和r3均为常量；
将左右车道线的置信度、道路宽度、车道线类型和宽度信息，融合得到车道中心线方程：
Figure QLYQS_95
，
其中，c0、c1、c2和c3均为常量；
所述车道中心线方程的坐标原点位于车辆后轴中心，x轴指向车辆前进的方向，y轴指向与车辆前进方向垂直的侧向平面。
3.根据权利要求1所述的车辆自主驾驶横向控制方法，其特征在于，所述步骤S2中，对所述车辆状态信息进行信号处理，具体包括如下步骤：
对车速信号和横摆角速度信号进行滤波处理，同时估算车辆的质心侧偏角、车辆行驶的道路状况，所述车辆行驶的道路状况包括车辆是否在沿着有坡道的道路行驶和路面的附着系数。
4.根据权利要求1所述的车辆自主驾驶横向控制方法，其特征在于：所述步骤S5中，根据预瞄点的横向控制偏差值，计算车辆期望的姿态角，具体包括如下步骤：
步骤S51、计算横向位置偏差
Figure QLYQS_96
：
Figure QLYQS_97
，
Figure QLYQS_98
；
步骤S52、对横向控制偏差值进行控制，计算得出车辆期望的姿态角
Figure QLYQS_99
：
Figure QLYQS_100
；
步骤S53、计算车辆期望的姿态角的控制补偿部分
Figure QLYQS_101
：
由于车辆在预瞄点处期望的车身姿态角和预瞄处的目标航迹的航向角一致：
Figure QLYQS_102
；
如果驾驶员的需求是车道线居中的情况下，那么：
Figure QLYQS_103
；
如果驾驶员的需求是车道线保持功能的情况下，那么：
Figure QLYQS_104
，
其中，
Figure QLYQS_105
表示横向位移的正负号，/>
Figure QLYQS_106
为标定常量；
步骤S54、对车辆期望的姿态角
Figure QLYQS_107
进行补偿：
Figure QLYQS_108
；
步骤S55、对车辆期望的姿态角
Figure QLYQS_109
进行修正，计算得出最终的车辆期望的姿态角
Figure QLYQS_110
。
5.根据权利要求4所述的车辆自主驾驶横向控制方法，其特征在于，所述步骤S6中，根据车辆期望的姿态角，计算车辆期望的姿态角控制偏差值，对车辆期望的姿态角控制偏差值进行控制，计算EPS电子助力转向控制器的期望转角，具体包括如下步骤：
步骤S61、计算车辆期望的姿态角控制偏差值
Figure QLYQS_111
：
Figure QLYQS_112
，
其中，
Figure QLYQS_113
，/>
Figure QLYQS_114
预瞄点处的车身姿态角/>
Figure QLYQS_115
；
步骤S62、对姿态角控制偏差值
Figure QLYQS_116
进行反馈控制：
采用PID控制算法对姿态角控制偏差值
Figure QLYQS_117
进行反馈控制，计算方法如下：
Figure QLYQS_118
；
步骤S63、对车辆期望的姿态角
Figure QLYQS_119
进行前馈补偿：
采用基于车道线曲率补偿方法对车辆期望的姿态角
Figure QLYQS_120
进行前馈补偿，计算方法如下：
Figure QLYQS_121
，
Figure QLYQS_122
，
其中，R是车道线的曲率半径，L是车辆的轮距，
Figure QLYQS_123
是车辆的纵向速度；/>
Figure QLYQS_124
是车辆的稳定性系数，/>
Figure QLYQS_125
表示车辆不足转向，/>
Figure QLYQS_126
表示车辆为中性转向，/>
Figure QLYQS_127
表示车辆为过度转向；
步骤S64、计算带前馈补偿的EPS电子助力转向控制器的期望转角
Figure QLYQS_128
：
Figure QLYQS_129
，
其中，参数
Figure QLYQS_130
是前馈补偿系数；
步骤S65、计算最终的EPS电子助力转向控制器的期望转角
Figure QLYQS_131
：
将所述步骤S64之中计算得到的
Figure QLYQS_132
，进行上下限幅，得到期望转角/>
Figure QLYQS_133
。
6.根据权利要求5所述的车辆自主驾驶横向控制方法，其特征在于，所述步骤S7中，根据EPS电子助力转向控制器的期望转角，计算EPS电子助力转向控制器的期望助力转矩，得到横向控制指令转矩，具体包括如下步骤：
步骤S71、计算EPS电子助力转向控制器的期望转角
Figure QLYQS_134
和实际转角的差值，得到EPS电子助力转向控制器的控制偏差/>
Figure QLYQS_135
：
Figure QLYQS_136
；
步骤S72、对EPS电子助力转向控制器的控制偏差
Figure QLYQS_137
进行控制，得出EPS电子助力转向控制器的期望转矩/>
Figure QLYQS_138
；
步骤S73、根据方向盘反馈转角或者反馈转矩的变化情况，对EPS电子助力转向控制器的请求转矩注入谐波补偿转矩，抑制EPS电子助力转向控制器的助力电机抖动，通过计算得到谐波补偿转矩
Figure QLYQS_139
；
步骤S74、计算带谐波补偿的EPS电子助力转向控制器的期望助力转矩
Figure QLYQS_140
：
Figure QLYQS_141
；
步骤S75、对
Figure QLYQS_142
做上下限值，得到横向控制指令转矩/>
Figure QLYQS_143
。
CN202310366227.7A 2023-04-07 2023-04-07 一种车辆自主驾驶横向控制方法 Active CN116080754B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310366227.7A CN116080754B (zh) 2023-04-07 2023-04-07 一种车辆自主驾驶横向控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310366227.7A CN116080754B (zh) 2023-04-07 2023-04-07 一种车辆自主驾驶横向控制方法

Publications (2)

Publication Number Publication Date
CN116080754A CN116080754A (zh) 2023-05-09
CN116080754B true CN116080754B (zh) 2023-07-14

Family

ID=86201086

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310366227.7A Active CN116080754B (zh) 2023-04-07 2023-04-07 一种车辆自主驾驶横向控制方法

Country Status (1)

Country Link
CN (1) CN116080754B (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104442814A (zh) * 2014-10-31 2015-03-25 重庆长安汽车股份有限公司 基于偏差预测算法的车道保持及自动对中系统和方法
KR101626020B1 (ko) * 2015-04-15 2016-06-01 주식회사 만도 차선 복귀 제어를 위한 차량의 목표 요레이트 생성 방법
CN108216225A (zh) * 2016-12-22 2018-06-29 丰田自动车株式会社 碰撞回避辅助装置
CN110329255A (zh) * 2019-07-19 2019-10-15 中汽研（天津）汽车工程研究院有限公司 一种基于人机协同策略的车道偏离辅助控制方法
CN110398966A (zh) * 2019-07-22 2019-11-01 广州小鹏汽车科技有限公司 一种路径跟踪控制方法及路径跟踪系统
CN112622899A (zh) * 2021-01-18 2021-04-09 中国重汽集团济南动力有限公司 一种基于预瞄面积控制的车辆车道保持方法及系统
CN113492907A (zh) * 2020-04-03 2021-10-12 郑州宇通客车股份有限公司 一种基于多点预瞄的车道保持方法及系统

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104442814A (zh) * 2014-10-31 2015-03-25 重庆长安汽车股份有限公司 基于偏差预测算法的车道保持及自动对中系统和方法
KR101626020B1 (ko) * 2015-04-15 2016-06-01 주식회사 만도 차선 복귀 제어를 위한 차량의 목표 요레이트 생성 방법
CN108216225A (zh) * 2016-12-22 2018-06-29 丰田自动车株式会社 碰撞回避辅助装置
CN110329255A (zh) * 2019-07-19 2019-10-15 中汽研（天津）汽车工程研究院有限公司 一种基于人机协同策略的车道偏离辅助控制方法
CN110398966A (zh) * 2019-07-22 2019-11-01 广州小鹏汽车科技有限公司 一种路径跟踪控制方法及路径跟踪系统
CN113492907A (zh) * 2020-04-03 2021-10-12 郑州宇通客车股份有限公司 一种基于多点预瞄的车道保持方法及系统
CN112622899A (zh) * 2021-01-18 2021-04-09 中国重汽集团济南动力有限公司 一种基于预瞄面积控制的车辆车道保持方法及系统

Also Published As

Publication number Publication date
CN116080754A (zh) 2023-05-09

Similar Documents

Publication Publication Date Title
WO2020187257A1 (zh) 车辆异常换道控制方法、装置及系统
JP6055525B1 (ja) 車両の走行制御装置
US10793141B2 (en) Vehicle traveling control apparatus
CN109421709B (zh) 车辆的驾驶辅助装置
CN112733270B (zh) 车辆行驶轨迹预测和轨迹偏离危险度评估的系统与方法
CN107128366B (zh) 用于对拖曳车辆通过弯道提供校正的车道跟随路径的系统和方法
US10696301B2 (en) Vehicle control device
US9457807B2 (en) Unified motion planning algorithm for autonomous driving vehicle in obstacle avoidance maneuver
US9849911B2 (en) Enhanced vehicle lateral control (lane following/lane keeping/lane changing control) for trailering vehicles
US9229453B1 (en) Unified motion planner for autonomous driving vehicle in avoiding the moving obstacle
EP3678110B1 (en) Method for correcting positional error and device for correcting positional error in a drive-assisted vehicle
US9227632B1 (en) Method of path planning for evasive steering maneuver
US9428187B2 (en) Lane change path planning algorithm for autonomous driving vehicle
US8190330B2 (en) Model based predictive control for automated lane centering/changing control systems
US11958477B2 (en) Driver assistance system for an at least partially automatically driving motor vehicle, motor vehicle and method for controlling a vehicle dynamics
CN105774905A (zh) 与电动助力转向控制器和后转向一体化的防碰撞控制
JP6579699B2 (ja) 車両の走行制御装置
CN111032492A (zh) 用于使铰接式车辆转向的方法
US11505191B2 (en) Vehicle traveling control device
WO2017142889A1 (en) Method for modifying steering of an automated vehicle for improved passenger comfort
CN115551756A (zh) 路径控制模块、相关联的路径控制设备以及相关联的方法
US20220324466A1 (en) Device for predictively controlling the movement of a motor vehicle
CN116080754B (zh) 一种车辆自主驾驶横向控制方法
US20220266903A1 (en) Vehicle control method, vehicle control system, and vehicle
US11299137B2 (en) Lateral control for vehicle wireless charging guidance

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