Skip to main content
. 2021 Mar 5;21(5):1813. doi: 10.3390/s21051813
Algorithm 1 RFU method with comprehensive metrics.
Require:ω1,ω2,a1,a2,m1,m2,j1,j2,qs1g1,qs2g2
Ensure:kmag,kacc,qcorr
 1:  initialize kmag,kacc
 2:  while sliding windows do
 3:   calculating the magnetometer measurement-based correction quaternion qmag using Equation (7)
 4:   calculating the accelerometer measurement-based correction quaternion qacc using Equation (6)
 5:   fusing qmag and qacc using Equation (8)
 6:   calculating the main axis’ projections in the reference frame [g1] using Equation (9)
 7:   forming the cost function as fi(kmag,kacc)=[j1]g1[j2]g1, and solving it using L-M method.
 8:  end while