|
Algorithm 2 Improved Initial Alignment Algorithm |
-
Require:
; Coarse alignment time ; Total alignment time T
-
1:
if
then
-
2:
if
then
-
3:
Denoise the inertial sensors’ information with the ELMEMD-Shannon method;
-
4:
Coarse alignment based on solidification coordinate frame;
-
5:
else
-
6:
Fine alignment with the RHCKF filter;
-
7:
end if
-
8:
end if
-
9:
return Output the alignment results
|