2) I set gravity_vector to [0.0, 0.0, 0.0] and set acc_bias to [0.0, 0.0, 9.81] (otherwise acceleration accumulates in the Z dimension rather than subtracts) and gyro bias to [0.0, 0.0, 0.0]
Based on my current understanding, I would expect that these two scenarios both yield the same result given the same input IMU messages. However, what I get are the two images below.
Is my expectation that these two scenarios yield identical results flawed? If so, can anyone explain how the gravity vector and the accelerometer bias are treated differently in the PIM prediction methods please?
Thanks!
NOTE: In the attached images, the red is showing our ground truth odometry (for comparison) while the green is showing our PIM predicted state every N messages (without reset). In both scenarios the PIM is initialized with zero velocity and at the same pose as the ground truth odometry starting pose.