Skip to main content
. 2016 Aug 2;16(8):1213. doi: 10.3390/s16081213
x(t) attitude of a robot at time t; x(t)=ϕ(t),θ(t),ψ(t)T, where ϕ(t), θ(t) and ψ(t) indicate roll, pitch and yaw
x^(t) attitude estimated at time t through prediction and a correction procedure; x^(t)=(ϕ^(t),θ^(t),ψ^(t))T
P^(t) error covariance of the estimated attitude x^(t)
x(t) attitude predicted at time t, before it is corrected by the measurements; x(t)=ϕ(t),θ(t),ψ(t)T
P(t) error covariance of the predicted attitude x(t)
a(t) acceleration measured in the instrument coordinate frame; a(t)=(ax(t),ay(t),az(t))T
aunit(t) normalized acceleration measurement; aunit(t)=(ax(t),ay(t),az(t))unitT=a(t)a(t)
m(t) magnetic field measured in the instrument coordinate frame; m(t)=(mx(t),my(t),mz(t))T
munit(t) normalized magnetic field measurement; munit(t)=(mx(t),my(t),mz(t))unitT=m(t)m(t)
z(t) measurements of roll, pitch and yaw calculated from the a(t) and m(t) at time t; z(t)=(ϕ(t),θ(t),ψ(t))T
v(t) linear velocity of the robot in the robot coordinate frame; v(t)=u(t),v(t),w(t)T
ω(t) rotational velocity of the robot in the robot coordinate frame; ω(t)=(p(t),q(t),r(t))T
g(·) motion model of a robot that relates the robot attitude x(t) and the linear velocity v(t) to the rotational velocity x˙(t) of the robot; x˙(t)=gx(t),v(t)
h(·) the measurement model that relates state x(t) to the measurement z(t); z(t)=h(x(t))
tk the k-th discretized sampling time instant
Δtk time period between t=tk1 and t=tk; Δtk=tktk1