基于驾驶人操控意图的车辆轨迹预测方法、装置及系统制造方法及图纸

本发明专利技术涉及一种基于驾驶人操控意图的车辆轨迹预测方法、装置及系统。本发明专利技术综合考虑驾驶意图和汽车实时运动状态对汽车的轨迹、速度和加速度参数进行短时预测，降低了驾驶人操控行为对汽车运动状态预测的扰动影响。该方法容易实现，且算法复杂度低，广泛适用于驾驶模拟器、汽车碰撞危险预警和汽车安全辅助驾驶系统，用于评估和预测运动车辆间的轨迹交叉和碰撞风险。

Vehicle trajectory prediction method, device and system based on driver's manipulation intention

The invention relates to a vehicle trajectory prediction method, device and system based on driver's manipulation intention. The invention comprehensively considers the driving intention and the real-time motion state of the vehicle to predict the vehicle's trajectory, speed and acceleration parameters for a short time, thereby reducing the disturbance effect of the driver's control behavior on the prediction of the vehicle's motion state. This method is easy to implement and has low computational complexity. It is widely used in driving simulators, vehicle collision hazard warning and vehicle safety assistant driving systems to evaluate and predict the trajectory crossing and collision risk between moving vehicles.

【技术实现步骤摘要】
基于驾驶人操控意图的车辆轨迹预测方法、装置及系统
本专利技术涉及一种预测方法、装置及系统，属于汽车控制
，具体是涉及一种基于驾驶人操控意图的车辆轨迹预测方法、装置及系统。
技术介绍
汽车运动状态的预测是汽车安全辅助驾驶的关键技术，通过对道路车辆行驶轨迹的预测，可分析与相邻车辆的行驶轨迹是否存在交叉的可能，以此来判断当前的行车安全状态。目前车辆行驶轨迹的预测是根据相邻车辆间的相对运动状态参数，来实时计算车间安全距离阈值，再与实际的车间距离比较，从而得出当前的行车安全状态。当检测到车间实际距离大于安全距离阈值时，认为汽车的行驶安全状况较为安全，反之则认为汽车在行驶过程中存在碰撞危险。
技术实现思路
专利技术所要解决的技术问题现有技术中的汽车防撞预警主要依赖先进的车载/路侧传感技术，以及信息处理方法获取汽车的运动状态信息，然而此类预测方法中没有考虑驾驶行为对汽车运动状态的改变量，而是将驾驶行为作用下的加速度改变量当作过程噪声来处理，所建立的模型不能准确的反映汽车的运动状态，导致了汽车运动状态预测结果误差增大。本专利技术的目的是提出一种于驾驶人操控意图的车辆运行轨迹预测方法、装置及系统。本专利技术通过分析驾驶和换道过程中驾驶人的感知、决策和操作特点，并考虑邻域范围内的多车行车意图和运动状态，以此来预测车辆间的行驶轨迹是否存在冲突。解决技术问题所采用的技术方案本专利技术的上述技术问题主要是通过下述技术方案得以解决的：一种基于驾驶人操控意图的车辆运行轨迹预测方法，包括：状态获取步骤，用于获取道路中车辆当前的运动状态以及驾驶人的操作意图；序列量化步骤，用于利用二次型理论将驾驶人期望操控量效用函数表示为离散化的序列形式；优值求解步骤，利用线性最优二次理论计算驾驶人期望控制量uk的最优解；状态预测步骤，基于所述将驾驶人控制量序列uk的最优解估计车辆在下一时刻的运动状态并判断是否存在碰撞风险。其中，所述序列量化步骤中，基于下式表示驾驶人期望操控量效用函数：式中Q为状态量的误差权重，R为控制量的权重矩阵，Qn为终端状态n时刻的权重矩阵，xn为目标车辆在n时刻的运动状态，xk为目标车辆在k时刻的运动状态，分别为xn、xk的转置矩阵,uk为第k时刻驾驶人期望的控制量。在本专利技术的至少一个实施例中，所述优值求解步骤具体包括以下子步骤：相对运动建模子步骤，将汽车相对运动状态模型表示为xk+1＝Φxk+Γuk，式中Φxk为当前运动状态与期望运动状态的偏差；根据车辆的运动学原理，状态矩阵Φ、控制矩阵Γ可以分别描述为：其中，T＝tk+1-tk。二次型最优求解子步骤，采用变分法求取离散装置线性二次型最优解，获取k时刻驾驶人期望的加速度控制量为Pn＝Qn；R为控制量的权重矩阵，Qn为终端状态n时刻的权重矩阵，ΦT为系数Φ的转置矩阵，根据线性最优二次型理论得到的最优解为控制输入预测子步骤，根据驾驶人的期望控制和汽车当前的运动状态，基于下式计算驾驶人的控制输入：其中，和分别表示目标汽车在纵向方向和横向方向的加速度。在本专利技术的至少一个实施例中，所述状态预测步骤中将所得的驾驶人操控量序列uk加入到传统的匀加速模型中，应用离散的Kalman预测算法短时估计车辆在下一时刻的运动状态和判断是否存在碰撞风险。在本专利技术的至少一个实施例中，将目标汽车运动状态分解为纵向方向运动和横向方向运动，将汽车的运动状态表示为：其中Zk表示车辆的运动状态，(Xk,Yk)表示目标车辆的位置坐标，和分别为Xk和Yk的一阶微分，表示目标车辆在纵向方向和横向方向的速度，和分别表示目标车辆在纵向方向和横向方向的加速度，uk表示k时刻驾驶人对汽车加速度的改变量。一种基于驾驶人操控意图的车辆运行轨迹预测装置，包括：状态获取模块，用于获取道路中车辆当前的运动状态以及驾驶人的操作意图；序列量化模块，用于利用二次型理论将驾驶人期望操控量效用函数表示为离散化的序列形式；优值求解模块，利用线性最优二次理论计算驾驶人期望控制量uk的最优解；状态预测模块，基于所述将驾驶人控制量序列uk的最优解估计车辆在下一时刻的运动状态并判断是否存在碰撞风险。其中，所述序列量化模块中，基于下式表示驾驶人期望操控量效用函数：式中Q为状态量的误差权重，R为控制量的权重矩阵，Qn为终端状态n时刻的权重矩阵，xn为目标车辆在n时刻的运动状态，xk为目标车辆在k时刻的运动状态，分别为xn、xk的转置矩阵,uk为第k时刻驾驶人期望的控制量。在本专利技术的至少一个实施例中，所述优值求解模块具体包括以下单元：相对运动建模单元，将汽车相对运动状态模型表示为xk+1＝Φxk+Γuk，式中Φxk为当前运动状态与期望运动状态的偏差，根据车辆的运动学原理，系数矩阵Φ、Γ可以描述为：其中，T＝tk+1-tk，t为汽车运动的时刻。二次型最优求解单元，采用变分法求取离散装置线性二次型最优解，获取k时刻驾驶人期望的加速度控制量为Pn＝Qn；R为控制量的权重矩阵，Qn为终端状态n时刻的权重矩阵，ΦT为系数Φ的转置矩阵，根据线性最优二次型理论得到的最优解为控制输入预测单元，根据驾驶人的期望控制和汽车当前的运动状态，基于下式计算驾驶人的控制输入：其中，和分别表示目标汽车在纵向方向和横向方向的加速度。在本专利技术的至少一个实施例中，所述状态预测模块中将所得的驾驶人操控量序列uk加入到传统的匀加速模型中，应用离散的Kalman预测算法短时估计车辆在下一时刻的运动状态和判断是否存在碰撞风险。一种包括上述装置的系统，包括：车载计算机，CAN总线平台，油门踏板传感器，制动踏板传感器，转向盘传感器，车载CCD摄像头，车载雷达，GPS/INS。专利技术效果本专利技术综合考虑驾驶意图和汽车实时运动状态对汽车的轨迹、速度和加速度参数进行短时预测，降低了驾驶人操控行为对汽车运动状态预测的扰动影响。本专利技术的方案容易实现，且复杂度低，能够广泛适用于驾驶模拟器、汽车碰撞危险预警和汽车安全辅助驾驶系统，用于评估和预测运动车辆间的轨迹交叉和碰撞风险。附图说明附图1：为本本专利技术实施例的结构示意图。附图2：为专利技术实施例的基本流程图；附图3a-c：为本专利技术实施例的模拟驾驶试验仿真效果图。具体实施方式下面通过实施例，并结合附图，对本专利技术的技术方案作进一步具体的说明。实施例：如图1所示，是本实施例的结构示意图。其中，计算机1，CAN总线2，油门踏板3，制动踏板4，转向盘5，摄像头6，雷达7，GPS8。如图2所示，本实施例的基于驾驶人操控意图的车辆运行轨迹预测方法，具体包括以下步骤：步骤1：利用车载设备和路侧设备获取道路中车辆当前的运动状态(位置、速度、加速度)和驾驶人的操作意图(油门踏板、制动踏板和转向灯信号)；步骤2：求取驾驶人期望的控制量序列，即量化驾驶人的操控意图。本实施例中，利用二次型理论将驾驶人期望操控量效用函数表示为一种离散化形式：式中Q为状态量的误差权重，R为控制量的权重矩阵，Qn为终端状态n时刻的权重矩阵，xk为目标车辆在k时刻的运动状态，uk为第k时刻驾驶人期望的控制量；步骤3：利用线性最优二次理论计算驾驶人期望控制量uk的最优解；目标车辆在短时预测过程中(T<0.5s)，驾驶人的操作状态基本不会发生改变，即uk在预测区间内是不变的，将汽车相对运动状态模型表示为xk+1＝Φxk+Γuk本文档来自技高网...

【技术保护点】
1.一种基于驾驶人操控意图的车辆运行轨迹预测方法，其特征在于，包括：状态获取步骤，用于获取道路中车辆当前的运动状态以及驾驶人的操作意图；序列量化步骤，用于利用二次型理论将驾驶人期望操控量效用函数表示为离散化的序列形式；优值求解步骤，利用线性最优二次理论计算驾驶人期望控制量uk的最优解；状态预测步骤，基于所述将驾驶人控制量序列uk的最优解估计车辆在下一时刻的运动状态并判断是否存在碰撞风险。

【技术特征摘要】
1.一种基于驾驶人操控意图的车辆运行轨迹预测方法，其特征在于，包括：状态获取步骤，用于获取道路中车辆当前的运动状态以及驾驶人的操作意图；序列量化步骤，用于利用二次型理论将驾驶人期望操控量效用函数表示为离散化的序列形式；优值求解步骤，利用线性最优二次理论计算驾驶人期望控制量uk的最优解；状态预测步骤，基于所述将驾驶人控制量序列uk的最优解估计车辆在下一时刻的运动状态并判断是否存在碰撞风险。2.根据权利要求1所述的一种基于驾驶人操控意图的车辆运行轨迹预测方法，其特征在于，所述序列量化步骤中，基于下式表示驾驶人期望操控量效用函数：式中Q为状态量的误差权重，R为控制量的权重矩阵，Qn为终端状态n时刻的权重矩阵，xn为目标车辆在n时刻的运动状态，xk为目标车辆在k时刻的运动状态，分别为xn、xk的转置矩阵,uk为第k时刻驾驶人期望的控制量。3.根据权利要求1所述的一种基于驾驶人操控意图的车辆运行轨迹预测方法，其特征在于，所述优值求解步骤具体包括以下子步骤：相对运动建模子步骤，将汽车相对运动状态模型表示为xk+1＝Φxk+Γuk，式中Φxk为当前运动状态与期望运动状态的偏差；根据车辆的运动学原理，状态矩阵Φ、控制矩阵Γ可以分别描述为：其中，T＝tk+1-tk。二次型最优求解子步骤，采用变分法求取离散装置线性二次型最优解，获取k时刻驾驶人期望的加速度控制量为Pn＝Qn；R为控制量的权重矩阵，Qn为终端状态n时刻的权重矩阵，ΦT为系数Φ的转置矩阵，根据线性最优二次型理论得到的最优解为控制输入预测子步骤，根据驾驶人的期望控制和汽车当前的运动状态，基于下式计算驾驶人的控制输入：其中，和分别表示目标汽车在纵向方向和横向方向的加速度。4.根据权利要求1所述的一种基于驾驶人操控意图的车辆运行轨迹预测方法，其特征在于，所述状态预测步骤中将所得的驾驶人操控量序列uk加入到传统的匀加速模型中，应用离散的Kalman预测算法短时估计车辆在下一时刻的运动状态和判断是否存在碰撞风险。5.根据权利要求4述的一种基于驾驶人操控意图的车辆运行轨迹预测方法，其特征在于，将目标汽车运动状态分解为纵向方向运动和横向方向运动，将汽车的运动状态表示为：其中Zk表示车辆的运动状态，(Xk,Yk)表示目标车辆的位置坐标，和分别为Xk和Yk的一阶微分，表示目标车辆在纵向方向和横向方向的速度，和分别表示...

【专利技术属性】
技术研发人员：彭理群，喻恺，卢赫，喻卓成，王园园，
申请(专利权)人：华东交通大学，
类型：发明
国别省市：江西,36