Skip to main content
. 2018 Sep 30;18(10):3297. doi: 10.3390/s18103297
Algorithm 2 Improved Initial Alignment Algorithm
  • Require: 

    k=0; Coarse alignment time Tcoarse; Total alignment time T

  •   1:

    if k1 then

  •   2:

        if k<Tcoarse then

  •   3:

            Denoise the inertial sensors’ information with the ELMEMD-Shannon method;

  •   4:

            Coarse alignment based on solidification coordinate frame;

  •   5:

        else Tcoarse<k<T

  •   6:

            Fine alignment with the RHCKF filter;

  •   7:

        end if

  •   8:

    end if

  •   9:

    return Output the alignment results