How to deal with the IMU data with gravity ,cause TangentPreintegration.cpp does not consider graviry

129 views
Skip to first unread message

TengQi Zhao

unread,
Nov 9, 2021, 11:02:19 PM11/9/21
to gtsam users

In TangentPreintegration.cpp, updatePreintegrated() function:

"Vector9 preintegratedPlus;
preintegratedPlus << // new preintegrated vector:
theta + w_tangent * dt, // theta
position + velocity * dt + a_nav * dt22, // position
velocity + a_nav * dt; // velocity"

Why not consider gravity?

Due to the gravity which is in included in my data , how do I deal with this situation. Should I feed the data into preintegration without any preprocess?

Frank Dellaert

unread,
Nov 10, 2021, 11:39:21 PM11/10/21
to gtsam users
Check testImuFactor.cpp
Reply all
Reply to author
Forward
0 new messages