Open narutojxl opened 3 weeks ago
Exp(-omega * dt) is almost near to identity matrix
yes, agree with you. BTW, @zhh2005757 , about Q2 and Q3, is there a typo in paper?
we calculate multiply delta t after calculating F_x, at the bottom line of the predict function.
There should be a transpose, since A as defined in the paper is left jacobian, not the right jacobian.
In theory, $$\frac{\partial{\dot{R}}}{{\partial{R}}} $$ in paper it is $$E_{XP}(-\hat{\omega_i} \Delta t)$$ should not disappear, it is calculated when there is a SO3 state.
获取 Outlook for iOShttps://aka.ms/o0ukef
发件人: Xiaoliang Jiao @.> 发送时间: 星期五, 八月 23, 2024 11:41 上午 收件人: hku-mars/IKFoM @.> 抄送: @. @.>; Mention @.***> 主题: [hku-mars/IKFoM] typos in df_dx ? (Issue #19)
This is an external email.
Hello @Joanna-HEhttps://github.com/Joanna-HE Thanks for your excellent work to share this toolkit. I have some foolish questions to look for your help, thanks in advance!
I notice when calculating $$F_{\tilde{x}}$$, in pape some items have $\Delta t$, but in the code, it disapper. Did we when calculating propagated covariance consider consective imu time diff $\Delta t$ in somewhere?
$$\frac{\partial{\dot{R}}}{ \partial{b_g} } $$ item in paper should not have transpose symbol, right? In code we approximate this right jacobin $$J_r$$ into identity matrix, the transpose symbol have very small effect. [image]https://github.com/user-attachments/assets/26578d8f-037b-4ad9-baea-12b2ee42ae15
Similar question about lidar measurement wrt true state $$x_k$$ jacobin $$J^k$$, evaluated at current estimated value $$\hat{\mathbf{x}}^k_k$$, it should also not have transpose symbol, right ? [image]https://github.com/user-attachments/assets/b6526137-3cc1-4ac5-b2a3-beb06d9eb65f
$$\frac{\partial{\dot{R}}}{{\partial{R}}} $$ in paper it is $$E_{XP}(-\hat{\omega_i} \Delta t)$$, but in code it disapper, cov(3, 3) = d(\dot{R}) / dR = Exp(-omega * dt)
― Reply to this email directly, view it on GitHubhttps://github.com/hku-mars/IKFoM/issues/19, or unsubscribehttps://github.com/notifications/unsubscribe-auth/ANJUIXVBGTENPKTRXQ32YQDZS2VOTAVCNFSM6AAAAABM7LPDJ2VHI2DSMVQWIX3LMV43ASLTON2WKOZSGQ4DEMJXGM4TCNI. You are receiving this because you were mentioned.Message ID: @.***>
@Joanna-HE, I'm really really thanks Dr. He kindly and detaily to solve my problem. Close it now!
@Joanna-HE , Dr. He, I'm so sorry to bother you again, i try to when fixing aboving typo get some troubles. Thanks for your kind help in advance!
The items circled in blue in the picture all have a coefficient dt, in df_dx() function we don't have dt. As you mentioned above "1. we calculate multiply delta t after calculating F_x, at the bottom line of the predict function."
The items circled in red in the picture do not have a coefficient dt in paper.
For example, $$\dot(P)/P$$ is Identity, this item has no dt in paper, $$dot(P)/V$$ is identity* dt in paper.
Q2: I notice in paper, these items: dot(P) / P = I, dot(V) / V = I, dot(bg) / bg = I, dot(ba) / ba = I, dot(g^w) / (g^w) = I, are all zero in df_dx() function. Should these items be I, or I /dt, or zero in df_dx() func?
Hello @Joanna-HE Thanks for your excellent work to share this toolkit. I have some foolish questions to look for your help, thanks in advance!
I notice when calculating $$F_{\tilde{x}}$$, in pape some items have $\Delta t$, but in the code, it disapper.
Did we when calculating propagated covariance consider consective imu time diff $\Delta t$ in somewhere?
$$\frac{\partial{\dot{R}}}{ \partial{b_g} } $$ item in paper should not have transpose symbol, right? In code we approximate this right jacobin $$J_r$$ into identity matrix, the transpose symbol have very small effect.
Similar question about lidar measurement wrt true state $$x_k$$ jacobin $$J^k$$, evaluated at current estimated value $$\hat{\mathbf{x}}^k_k$$, it should also not have transpose symbol, right ?
$$\frac{\partial{\dot{R}}}{{\partial{R}}} $$ in paper it is $$E_{XP}(-\hat{\omega_i} \Delta t)$$, but in code it disapper, cov(3, 3) = d(\dot{R}) / dR = Exp(-omega * dt)
https://github.com/hku-mars/IKFoM/blob/59cfc095ca74425f9b330c7c04a5d74f68c6dd62/Sample_1/FAST_LIO/include/use-ikfom.hpp#L110-L126