Skip to main content
. 2019 Jan 15;19(2):330. doi: 10.3390/s19020330
x(t) attitude of a robot at time t; x(t)=ϕ(t),θ(t),ψ(t)T where ϕ(t), θ(t), and ψ(t)
indicate the roll, pitch, and yaw, respectively
x^(t) attitude predicted for time t, before being corrected using the measurements;
x^(t)=ϕ^(t),θ^(t),ψ^(t)T
x^(t) attitude estimated for time t through the prediction and correction procedure;
x^(t)=ϕ^(t),θ^(t),ψ^(t)T
a(t) acceleration measured at time t in the instrument coordinate frame;
a(t)=(ax(t),ay(t),az(t))T
au(t) normalized acceleration measurement; au(t)=(axu(t),ayu(t),azu(t))T=a(t)a(t)
m˜(t) magnetic field measured in the instrument coordinate frame;
m˜(t)=(m˜x(t),m˜y(t),m˜z(t))T
bm(t) bias in the magnetic field measurement m˜(t); bm(t)=(bmx(t),bmy(t),bmz(t))T
m(t) magnetic field wherein the bias bm(t) is compensated from measurement m˜(t);
m(t)=(mx(t),my(t),mz(t))T=m˜(t)bm(t)
mu(t) normalized magnetic field measurement; mu(t)=(mxu(t),myu(t),mzu(t))T=m(t)m(t)
mg(t) geomagnetic field represented in the North-East-Down (NED) coordinate frame
appropriate for the geographical location; mg(t)=(mg,x(t),mg,y(t),mg,z(t))T
zu(t) normalized field measurement at time t; zu(t)=(au(t),mu(t))T
u(t) linear velocity measured by a Doppler velocity log (DVL) in the instrument coordinate
frame; u(t)=u(t),v(t),w(t)T
ω(t) rotational (angular) velocity measured by a gyroscope in the instrument coordinate frame;
ω(t)=(p(t),q(t),r(t))T
f(·) motion function relating attitude x(t) and angular velocity ω(t) in the instrument
coordinate frame to the robot’s angular velocity x˙(t); x˙(t)=fx(t),ω(t)
h(·) measurement function relating state x(t) to measurement zu(t); zu(t)=h(x(t))
tk the kth discretized sampling instant of time
Δtk time period between t=tk1 and t=tk; Δtk=tktk1