openxrlab / xrslam

OpenXRLab Visual-inertial SLAM Toolbox and Benchmark

Geek Repo:Geek Repo

Github PK Tool:Github PK Tool

imu initialization question

lturing opened this issue · comments

firstly, thanks for this great work!
recently, i read imu initialized codes, i find some questions
likes here, take an example

A.block<3, 3>(i * 6, 0) =  -0.5 * delta.t * delta.t * matrix<3>::Identity();

i think it should be

A.block<3, 3>(i * 6, 0) += -0.5 * delta.t * delta.t * matrix<3>::Identity();

do i miss some parts?