公开(公告)号：CN112683281A

公开(公告)日：2021-04-20

申请号：CN202110263051.3

申请日：2021-03-11

Applicant: 之江实验室

Inventor： 时强 ,  朱永东 ,  刘云涛 ,  陈培俊 ,  吴迎笑 ,  杨斌 ,  朱凯男 ,  王角

IPC: G01C21/28

Abstract: 本发明公开一种基于车辆运动学的自动驾驶车辆联合定位方法，该方法利用双目相机及IMU获取环境及车辆运动信息进行车辆状态估计，借助车辆总线获取车辆侧偏角构建运动约束，该方法通过引入车辆本身的运动学模型，将其作为车辆在利用双目视觉和IMU惯性测量单元进行定位过程中本身运动的约束，构建车辆位姿状态估计的优化模型，迭代求解获得符合车辆运动学模型的车辆定位结果，该方法在定位优化过程中借助于运动学约束，将车辆运动学与状态估计的优化模型相结合，得到适应车辆自身运动的定位轨迹信息，有效提高了视觉惯性联合定位优化模型本身的鲁棒性和精确性，适用于自动驾驶车辆在复杂环境下的定位问题。

公开(公告)号：CN112683281B

公开(公告)日：2021-06-04

申请号：CN202110263051.3

申请日：2021-03-11

Applicant: 之江实验室

Inventor： 时强 ,  朱永东 ,  刘云涛 ,  陈培俊 ,  吴迎笑 ,  杨斌 ,  朱凯男 ,  王角

IPC: G01C21/28

Abstract: 本发明公开一种基于车辆运动学的自动驾驶车辆联合定位方法，该方法利用双目相机及IMU获取环境及车辆运动信息进行车辆状态估计，借助车辆总线获取车辆侧偏角构建运动约束，该方法通过引入车辆本身的运动学模型，将其作为车辆在利用双目视觉和IMU惯性测量单元进行定位过程中本身运动的约束，构建车辆位姿状态估计的优化模型，迭代求解获得符合车辆运动学模型的车辆定位结果，该方法在定位优化过程中借助于运动学约束，将车辆运动学与状态估计的优化模型相结合，得到适应车辆自身运动的定位轨迹信息，有效提高了视觉惯性联合定位优化模型本身的鲁棒性和精确性，适用于自动驾驶车辆在复杂环境下的定位问题。