Open KangliC opened 4 years ago
https://github.com/zarathustr/FKF/blob/7b92758e54c35110346badd967e0625bafd0089d/main_performance.m#L74
The third low of the dk matrix should be (q3 q0 -q1).
Based on equation 24 in Paper, The third row should be q2 -q0 -q1. The image is attached below:
https://github.com/zarathustr/FKF/blob/7b92758e54c35110346badd967e0625bafd0089d/main_performance.m#L74
The third low of the dk matrix should be (q3 q0 -q1).