Skip to main content
. 2019 Sep 20;19(19):4061. doi: 10.3390/s19194061
p=pNpEpDT position with respect to the NED coordinate frame.
v=vNvEvDT velocity with respect to NED coordinate frame.
g=00gzT gravity acceleration vector, where gz=9.81 m/s2.
RbNED rotation matrix between the body coordinate frame and the NED coordinate frame.
uk input vector.
am,k accelerometer measurement.
em,k orientation measurement in unit quaternion.
βa,k accelerometer bias.
qa,k acceleration measurement noise.
qβ,k random walk noise.
qe,k orientation measurement noise.
p`kc cloned state vector.
xk state vector.
yk output measurement.
pm,k position measurement given by GNSS.
vm,k velocity measurement given by GNSS.
rp,k position measurement noise.
vp,k velocity measurement noise.
δm,k relative measurement given by LO.
rδ,k relative measurement noise.
f(·) process model.
h(·) observation model.
x^k state estimate.
Pkxx covariance matrix of state estimate.
qk process noise.
Qk covariance matrix of process noise.
rk output measuremnt noise.
Rk covariance matrix of output measurement noise.
R0 nominal covariance matrix of output measurement noise.
R^k estimate of the covariance matrix of output measurement noise.
νk innovation.
ϵk,iν normalized innovation squared.
ξ MAV’s path.
ϑ vector field