[发明专利]一种用于车辆自适应巡航控制系统的目标提取方法

摘要

本发明公开了一种用于车辆自适应巡航控制系统的目标提取方法，利用ESR雷达传感器识别前方目标，提取目标数据，判断目标是否为目标车辆还是目标物体；针对前方目标物体的数据，利用最小二乘法进行三次曲线拟合，拟合出的三次曲率曲线来表示道路边沿情况，利用拟合的三次曲线提前估计车辆前方行驶道路情况，判断是否需要退出自适应巡航控制系统；在弯道处时进行弯道识别，判断主车前方目标是否为有效目标。本发明能准确识别正在跟踪的车辆，保障自适应巡航控制系统在使用中的行车安全性。

主权项

1.一种用于车辆自适应巡航控制系统的目标提取方法，其特征是：/n所述车辆是指具有自适应巡航控制系统功能的主车，所述目标包括主车前方、且与主车按相同方向行进的目标车辆，以及处在主车前方道路两侧的目标物体；/n在所述主车上配置有GPS定位系统和毫米波雷达；所述毫米波雷达通过目标合并输出目标信号，所述目标信号包括目标ID号、主车与目标之间的距离ρ、主车与目标之间的相对速度v，以及主车与目标之间的相对方位角θ；/n所述目标提取方法按如下步骤进行：/n步骤1：利用相对方位角θ，根据式(1)计算获得主车与目标之间的纵向距离为d_y，以及主车与目标之间的侧向距离为d_x，/n /n纵向是指沿着主车的行驶方向，所述侧向是指垂直于主车的行驶方向；/n步骤2、利用主车上的GPS定位系统检测获得主车的行驶速度v_a，利用所述毫米波雷达检测获得目标相对于主车的径向速度v_r，则：目标相对于主车的切向速度v_t为：/n其中，ν_r＝v，为θ的微分值；/n径向是指主车与目标连线的方向，切向是指垂直于主车与目标连线的方向；/n利用式(2)计算获得目标相对于主车的纵向速度v_y；利用式(3)计算获得目标相对于主车的侧向速度为v_x；/nv_y＝v_rcosθ-v_tsinθ (2)，/nv_x＝v_rsinθ+v_tcosθ (3)；/n步骤3、按如下方式对目标进行判断：/n针对主车与目标A，在毫米波雷达的连续三个检测周期内，若是满足条件一，则判断目标A为静止目标A1，/n设置条件一为：|v_y-v_a|＜0.1m/s；/n在所述主车与静止目标A1之间，若不满足条件二，则判断静止目标A1为目标车辆；/n在所述主车与静止目标A1之间，若满足条件二，则判断静止目标A1为目标物体；/n设置条件二为：|d_x|≥4.5m；/n步骤4：针对目标物体，按如下方式获得道路曲线：/n定义坐标系：以纵向为y轴向，以侧向为x轴向，以雷达中心点为坐标原点；/n利用目标物体的目标信号，采用最小二乘法进行拟合，获得由式(4)所表征的道路曲线y(x)：/ny(x)＝p₁₁x³+p₁₂x²+p₁₃x+p₁₄ (4)，/n其中，x和y分别由式(1)计算获得：y(x)＝d_y，x＝d_x；/n利用式(5)所示的正规方程组求解获得各系数p₁₁、p₁₂、p₁₃和p₁₄：/n /n其中，m是由毫米波雷达检测获得、且按时间序列排布的目标信号的个数，m至少为4，x_k为m个目标信号中第k个目标信号中的x的值；y_k为的m个目标信号中第k个目标信号中的y的值；/n步骤5：根据所获得的由式(4)所表征的道路曲线，按如下方式选取道路曲线的有效区域：/n设定：道路曲线有效区域的x值为：0≤x≤x_m；取x＝x_m，利用式(4)计算获得y(x_m)；/n定义：雷达中心点在沿侧向上延伸并于道路侧边形成的交点为P1点；道路曲线中(x_m，y(x_m))点为P2点；/nP1与P2的连线为P1P2；获得连线P1P2与主车行进方向的夹角为β角；/n步骤6：按照β角的阈值对是否需要退出自适应巡航控制系统做出处理；/n若β角大于10°，判断为不适于自适应巡航的工作模式，退出自适应巡航；/n若β小于0.1°，判断道路为近似直线，主车保持为自适应巡航的工作模式；/n若β角度在0.1°和10°之间，判断为主车处在弯道中；/n针对处在弯道中的主车，判断处在主车前方的目标车辆为有效目标或为无效目标；若为有效目标，则主车保持与有效目标之间的自适应巡航工作模式；若为无效目标，则主车退出自适应巡航工作模式；/n所述有效目标是指：目标车辆与主车处于同一车道中；/n所述无效目标是指：目标车辆与主车处于不同车道中。/n