LKA系统算法设计说明书

LKA车道保持辅助系统算法设计说明书

编制：审核：签名：日期：批准：签名：日期：

更改历史版本更改描述更改日期更改人1.0初始版本目录TOC\o"1-5"\h\z概述 4\o"CurrentDocument"目的 4适用范围 4系统算法功能定义 4系统功能算法设计 4\o"CurrentDocument"3.1系统的接口定义 5\o"CurrentDocument"LDW系统模块组成 7功能模块算法设计 8横向偏离速度模块 8偏离预警逻辑处理模块 81概述1.1目的根据云度A101低成本样车ADAS系统功能需求和测试标准，本文定义了车道保持辅助子系统算法设计方案并对系统算法设计进行描述说明，为后续车道保持辅助系统学习、开发、性能优化及产品性能测试提供指导。1.2适用范围本文档适用于“车道保持辅助系统”(以下简称LKA)的算法开发、系统嵌入式软件开发、LKA产品性能测试过程。2系统算法功能定义根据云度A101低成本样车ADAS系统LKA子系统功能需求，其算法功能定义如下：当车辆在车道内行驶，如果有偏离出本车道的趋势以及已经偏出本车道一部分时，LKA系统会触发并使方向盘自动响应，使车辆驶回车道中心附近；LKA系统能够根据当前车道线信息，实时计算当前时刻的方向盘期望转角，这个期望转角能使车辆稳定行驶在车道中，当系统使能时，此期望转角就发给转向电机，并使方向盘转动从而使车辆驶回车道中心附近；车辆具备识别车道线功能，当车道线和光线较好情况下，能够根据当前车道线给出相对于自车位置的车道，并判断是否满足车道保持功能的条件；驾驶员可通过APP进行LKA功能的开启与关闭；驾驶员踩刹车或打转向灯进行主动干预时，LKA功能需要关闭；当驾驶员主动干预结束后LKA功能自动恢复；LKA系统适用工况：光线较好、车道线良好的、半径大于200m的车道(20~70km/h)；注：开启双闪灯状态下，LKA功能关闭；3系统功能算法设计LKA系统功能算法设计方案包括系统接口定义、系统模块划分及功能模块

算法设计三部分。3.1系统的接□定义LKA系统的接口定义如下。图1LKA系统接口定义示意图表1LKA系统接口定义列表变量类型编号信号名称描述备注输入变量1leftoffset距离左车道线的偏距m2rightoffset距离右车道线的偏距m3vehiclehalfwidth车身宽度的一半m4appldkenableApp使能信号0/15vehiclespeed本车车速km/h

6gear档位信号7minspeed最小使能车速km/h8turnleft左转向灯信号9turnright右转向灯信号10brakestatus刹车信号11xpreviewnear2近处预瞄点左侧的x坐标m12ypreviewnear2近处预瞄点左侧的y坐标m13roadpointheading2近处预瞄点左侧的航向角deg14xpreviewnear1近处预瞄点右侧的x坐标m15ypreviewnear1近处预瞄点右侧的y坐标m16roadpointheading1近处预瞄点右侧的航向角deg14xpreview远处预瞄点的x坐标m15ypreview远处预瞄点的y坐标m16roadpointheading远处预瞄点的航向角deg17disfrontrear前后轴间距m18disleftright后轴长度m输出变量1lkawarningLKA使能信号2lkawarningleftrightLKA左右车道线预警信号3lkastateLKA状态信号4lkalaneinfo左右车道线信号5targetangle方向盘期望转角deg

3.2LKA系统模块组成LKA系统主要由使能模块和方向盘期望转角计算模块组成，如图2和图3所示。kk图2LKA系统使能模块示意图

QUS-QUS-图3LKA系统期望转角计算模块示意图3.3功能模块算法设计本节主要介绍LKA系统中各功能模块的算法。使能模块使能模块的功能是根据得到的车道线，计算车辆在一定时间内是否有偏出本车道的趋势，原理与车道偏离预警(LDW)系统一致，在此不再重复。期望转角计算模块期望转角是根据车辆与当前车道的相对位置关系得到的，具体是根据车辆Ackermann运动模型计算得到。车辆以圆弧曲线运动来确定前轮中点转角的方法是选取车辆前方一定距离d处的期望路径上的坐标点(x_t,y_t)，如图4所示。假设以固定转角0进行圆弧转弯运动，正好到达那个目标点，那么这个前轮转角0就是当前时刻应该发出的期望转角，并在下一个采样时间用同样的方法进行更新。

(Vry_t)y_c)V11(Vry_t)y_c)V11图4圆弧确定前轮转角确定圆弧半径R的方法：如果车身朝向正对着预瞄点，那么R为无穷大，期望前轮转角为0；如果车身没有正对着预瞄点，则定义车辆第二轴的中点坐标为(x_0,y_0),预瞄点坐标为(x_t,y_t)，这两对坐标值为已知，并且圆弧中心的坐标(x_c,y_c)一定是在第二轴两轮连线的延长线上，那么圆心坐标应满足(x_c-x_0)A2+(y_c-y_0)A2=(x_c-x_t)A2+(y_c-y_t)A2y_c=k*x_c+b其中，k和b由第二轴两轮的坐标来决定。当得到圆心坐标后，圆弧半径为R=sqrt((x_c-x_O)人2+(y_c-y_0)人2)则此时前轮中点期望转角为乞t=arctan(L/R) (1)通过(1)式计算得到的前轮转角是根据车辆和预瞄点的位置准确地计算得出，并且也具有一定的物理含义，避免了参数和系数的选取，从而可以适应不同的车型。将(1)式中的结果变成角度值，并通过方向盘对前轮转角的传动比转换，即