[发明专利]一种基于多传感器联合配准融合的驾驶系统和融合方法

说明书

一种基于多传感器联合配准融合的驾驶系统和融合方法，包括相互通信的前车和后车，所述前车和后车上均设置有信息传感单元、通信单元、控制单元和信息融合单元，信息融合单元采用车载控制芯片，用于综合本车的GPS信息、当前车辆与前车或后车的雷达测距信息、当前车辆与前车或后车的超声波测距信息以及通过通信单元获取的前车或后车传感器获得的GPS信息、前车或后车与当前车的雷达测距信息、前车或后车与当前车辆的超声波测距信息并融合通讯误差，进而判断当前车辆相对于前车或后车的运动状态，并通过向控制单元发送指令调整车辆行驶状态，实现了将车辆本身的多传感器信息与经通讯获得导航信息进行融合，大大提高了车辆导航精度。

技术领域

本发明涉及一种驾驶系统，具体涉及一种基于多传感器联合配准融合的驾驶系统和融合方法。

背景技术

研究表明在组合导航系统中采用多传感器信息融合技术可以扩展整个系统的时间和空间覆盖率，增加系统的信息利用率，提高融合数据的置信度和精度，增强系统的容错性和可靠性。

尽管对单个车辆的多传感器集成有了一些研究，但考虑车辆之间通讯的信息融合研究较少，且现有的车辆之间通讯的信息融合是在假设车辆之间通讯没有任何误差的情况下进行的，但实际应用中，车辆之间的通讯必然会受到各种干扰因素的影响，存在通讯误差以及通讯中断等，故得到的车辆导航精度差。

发明内容

针对上述现有技术存在的问题，本发明提供一种基于多传感器联合配准融合的驾驶系统和融合方法，该系统和方法考虑车辆之间通讯的信息融合，能够将车辆本身的多传感器信息与经通讯获得的导航信息进行融合，提高车辆导航精度。

为了实现上述目的，本发明提供一种基于多传感器联合配准融合的驾驶系统，包括相互通信的前车和后车，所述前车和后车上均设置有信息传感单元、通信单元、控制单元和信息融合单元；

所述信息传感单元包括GPS传感器、激光雷达测距传感器和超声波测距传感器，GPS传感器用于接收卫星信号，对当前车辆进行实时定位；激光雷达测距传感器用于实时获取当前车辆与前车或后车的雷达测距信息；超声波测距传感器用于实时获取当前车辆与前车或后车的超声波测距信息；

所述通信单元包括信号接收传感器和信号发射传感器，所述信号接收传感器用于接收信息传感单元的信息数据信号，信号发射传感器用于将接收到的信息传感单元的信息数据信号发送至信息融合单元；

所述控制单元包括自动转向控制机构、自动油门控制机构、车辆自动制动机构和自动灯光系统；

所述信息融合单元采用车载控制芯片，用于综合本车的GPS信息、当前车辆与前车或后车的雷达测距信息、当前车辆与前车或后车的超声波测距信息以及通过通信单元获取的前车或后车传感器获得的GPS信息、前车或后车与当前车的雷达测距信息、前车或后车与当前车辆的超声波测距信息并融合通讯误差，进而判断当前车辆相对于前车或后车的运动状态，并通过向控制单元发送指令调整车辆行驶状态。

进一步地，所述通信单元采用基于专用短程的通讯协议或Zigbee通讯协议进行通信。

一种基于多传感器联合配准融合的驾驶系统的融合方法，包括如下步骤：

1)通过GPS获取车辆信息，用公式表示为：

式中：为通过GPS获得的包含测量误差的车辆位置信息，为通过GPS获得的包含测量误差的车辆速度信息；p_n(k)为车辆实时位置信息，v_n(k)为车辆实时速度信息；τ^G为系统时间偏差，和为高斯白噪声以表示GPS的随机测量误差；

2)对步骤1)中的GPS信息进行简化，简化后的公式为：

其中，