[发明专利]获得车辆定位信息的方法及装置

摘要

本发明涉及车辆定位技术领域，提供一种获得车辆定位信息的方法及装置。该方法首先构建用于表示车辆在多个时刻的导航状态以及多个时刻的导航状态之间的约束关系的因子图，然后确定因子图中多个时刻的导航状态的初始值，最后基于多个时刻的导航状态的初始值，以及多个时刻的导航状态之间的约束关系对因子图进行优化求解，进而将多个时刻中的目标时刻的导航状态的优化值确定为车辆在目标时刻的定位信息。在该方法中，由于充分考虑了各导航状态之间的约束关系，因此求解出的导航状态的优化值能够准确地估计车辆在目标时刻的真实的导航状态，进而将该优化值作为车辆在目标时刻的定位信息，能够实现对车辆的准确定位，改善自动驾驶的效果。

主权项

1.一种获得车辆定位信息的方法，其特征在于，包括：/n构建用于表示车辆在多个时刻的导航状态以及所述多个时刻的导航状态之间的约束关系的因子图，其中，每个时刻的导航状态均包括所述车辆在该时刻的位姿、速度以及惯性测量单元IMU的零偏量，所述多个时刻包括目标时刻；/n确定所述因子图中所述多个时刻的导航状态的初始值；/n基于所述多个时刻的导航状态的初始值，以及所述多个时刻的导航状态之间的约束关系对所述因子图进行优化求解；/n将所述目标时刻的导航状态的优化值确定为车辆在所述目标时刻的定位信息；/n其中，所述因子图包括：/n多个节点组，用于表示所述多个时刻的导航状态，其中，每个节点组均包括X节点、V节点以及B节点，分别对应所述多个时刻的导航状态中一个时刻的导航状态的位姿、速度以及IMU的零偏量，所述多个节点组在所述因子图中按照所述多个时刻的时间先后顺序排列；/n多个约束因子，用于表示所述多个时刻的导航状态之间的约束关系对应，每个约束因子均与所述因子图中的至少一个节点连接，用于表示存在于所述至少一个节点之间的约束关系；所述多个约束因子包括先验因子、全球定位系统GPS因子、绝对位姿因子、相对位姿因子、IMU因子以及IMU偏移量因子中的至少一种约束因子，其中，/n所述先验因子能够与所述因子图的第一个节点组的X节点、V节点或B节点连接，所述先验因子为基于所述多个时刻中的最早时刻之前的导航状态或观测量构建的约束方程；/n所述GPS因子能够与所述因子图的任意一个X节点连接，所述GPS因子为基于GPS的观测量构建的约束方程；/n所述绝对位姿因子能够与所述因子图的任意一个X节点连接，所述绝对位姿因子为基于视觉定位系统的观测量构建的约束方程；/n所述相对位姿因子能够分别与所述因子图的任意两个不同的X节点连接，所述相对位姿因子为基于轮速里程计的观测量构建的约束方程；/n所述IMU因子能够分别与所述因子图的任意一个节点组的X节点、V节点以及B节点连接，以及分别与和该节点组相邻的下一个节点组的X节点以及V节点连接，所述IMU因子为基于IMU的观测量构建的约束方程；/n所述IMU偏移量因子能够分别与所述因子图的任意两个相邻的B节点连接，所述IMU偏移量因子为基于IMU的零偏量的偏移量构建的约束方程。/n