I notice that you changed the expression to calculate the 'F matrix' and 'V matrix' in preintegrationBase.h.
The original definition in 'vins mono' is :
'F.block<3, 3>(0, 12) = -0.25 result_delta_q.toRotationMatrix() R_a_1_x dt dt -dt;'
' V.block<3, 3>(0, 0) = 0.25 delta_q.toRotationMatrix() dt dt;'
'V.block<3, 3>(0, 6) = 0.25 result_delta_q.toRotationMatrix() dt dt;'
Somehow, they are modified as:
'F.block<3, 3>(0, 12) = -0.1667 result_delta_q.toRotationMatrix() R_a_1_x dt dt -dt;'
'V.block<3, 3>(0, 0) = 0.5 delta_q.toRotationMatrix() dt dt;'
''V.block<3, 3>(0, 6) = 0.5 result_delta_q.toRotationMatrix() dt dt;''
There must be something that you explored, and then you modified them.
Could you please explain more about it with your professional insight?
I notice that you changed the expression to calculate the 'F matrix' and 'V matrix' in preintegrationBase.h. The original definition in 'vins mono' is : 'F.block<3, 3>(0, 12) = -0.25 result_delta_q.toRotationMatrix() R_a_1_x dt dt -dt;' ' V.block<3, 3>(0, 0) = 0.25 delta_q.toRotationMatrix() dt dt;' 'V.block<3, 3>(0, 6) = 0.25 result_delta_q.toRotationMatrix() dt dt;' Somehow, they are modified as: 'F.block<3, 3>(0, 12) = -0.1667 result_delta_q.toRotationMatrix() R_a_1_x dt dt -dt;' 'V.block<3, 3>(0, 0) = 0.5 delta_q.toRotationMatrix() dt dt;' ''V.block<3, 3>(0, 6) = 0.5 result_delta_q.toRotationMatrix() dt dt;'' There must be something that you explored, and then you modified them. Could you please explain more about it with your professional insight?