[发明专利]一种基于GNSS/INS的车辆轮廓识别与避障方法

权利要求书

1.一种基于GNSS/INS的车辆轮廓识别方法，其特征在于，每个车辆上安装有GNSS接收机和INS设备，且具有5G通讯功能，所述方法包括如下步骤：

S1：获取并存储每个车辆的静态三维轮廓信息，包括静态三维数据轮廓模型与GNSS接收机和INS设备安装位置数据；

S2：根据每个车辆的GNSS接收机的GNSS观测值以及INS设备输出的车辆载体动态信息，采用非差GNSS/INS联合解算，获得每个车辆的位置、速度、姿态的第一估计值；

S3：建立5G基站狄洛尼三角网络拓扑结构，其中各5G基站收集接入该5G基站的所有车辆以及接入包含该5G基站的三角网连线另一端的5G基站的所有车辆的位置的第一估计值，获得以每个车辆为中心车辆，其一定范围内的周边车辆的5G通讯协议信息，并将其报告至所述中心车辆，所述一定范围兼顾5G通讯协议信息数据量和车辆端到端通信距离设定；

S4：每个中心车辆获得其周边车辆的5G通讯协议信息后，与其周边车辆建立D2D通讯，之后周边车辆获取其中心车辆的静态三维数据轮廓模型与GNSS接收机和INS设备安装位置数据；

S5：获取每个中心车辆与其周边车辆的双差GNSS观测值，结合该中心车辆的INS输出值，按照RTK/INS紧组合模式解算，获取中心车辆相对于其周边车辆的位置、速度、姿态的第二估计值；

S6：根据在步骤S4中获取的中心车辆的静态三维数据轮廓模型与GNSS接收机和INS设备安装位置数据，以及在步骤S5中获取的中心车辆相对于其周边车辆的位置、速度、姿态的第二估计值，获得中心车辆相对于其周边车辆的动态三维轮廓信息，所述动态三维轮廓信息包括中心车辆的静态三维数据轮廓模型、中心车辆相对于其周边车辆的速度和姿态信息。

2.根据权利要求1所述的方法，其特征在于，步骤S1中，

当GNSS接收机和INS设备相对于车辆位置进行标准化安装时，将车辆的车辆品牌+车辆型号、车辆的静态三维数据轮廓模型与GNSS接收机和INS设备安装位置数据上传至公共服务器，每个车辆通过访问所述公共服务器将不同车辆品牌+车辆型号、车辆的静态三维数据轮廓模型与GNSS接收机和INS设备安装位置数据下载至该车辆的本地存储介质；

当GNSS接收机和INS设备相对于车辆位置进行非标准化安装时，将该车辆的车辆品牌+车辆型号、车辆的静态三维数据轮廓模型与GNSS接收机和INS设备安装位置数据下载至该车辆的本地存储介质。

3.根据权利要求1所述的方法，其特征在于，步骤S2中，所述GNSS/INS联合解算为实时GNSS伪距单点定位与INS松组合、实时GNSS伪距单点定位与INS紧组合、实时GNSS精密单点定位与INS松组合或实时GNSS精密单点定位与INS紧组合。