Remove bias drift from FactorImu
Proposal:
-
Use only a factor that takes into account IMU measurements linking POVB_1 and POV_2.
-
the drift is taken care of by a second factor of the type FactorBlockRelative.
-
The ProcessorImu takes care to use a single FactorImu (case of static bias) or a FactorImu plus a FactorBlockRelative (case of dynamic bias)
Edited by Joan Solà Ortega