公开(公告)号：US20190204084A1

公开(公告)日：2019-07-04

申请号：US16302024

申请日：2018-07-18

Applicant: GOERTEK INC.

Inventor： Haoran SONG ,  Tianrong DAI ,  Yuchuan REN ,  Shunming LI ,  Jinxi CAO

IPC: G01C21/18 ,  G01C21/20 ,  G01C21/00 ,  G05D1/02

CPC classification number: G01C21/18 ,  G01C21/005 ,  G01C21/165 ,  G01C21/20 ,  G05D1/02

Abstract: A binocular vision localization method, device and system are provided. The method includes calculating first pose change information according to two frames of images collected by a binocular camera unit at two consecutive moments and calculating second pose change information according to inertia parameters collected by an inertial measurement unit between the two consecutive moments. Matched feature points in the two frames are extracted from the two frames respectively. A reprojection error of each feature point is calculated. The calculations are taken as nodes or edges of a general graph optimization algorithm to acquire optimized third pose change information for localization. The system includes a binocular vision localization device, and a binocular camera unit and an inertial measurement unit respectively connected thereto, a left-eye camera and a right-eye camera are symmetrically located on two sides of the inertial measurement unit. This can improve accuracy and real-time performance for pose estimation.