Skip to main content
. 2015 May 11;15(5):11050–11075. doi: 10.3390/s150511050
x(t) pose of a robot at time t; x(t) = (x(t), y(t), θ(t))T
θ(t) heading angle of the robot at time t
NW number of range data measured by an LRF; in this study, NW = 19
riW(t)
the i-th range data from a robot to the walls measured by an LRF
zW(t) vector of the measured range data by an LRF; zW(t)=(r1W(t),r2W(t),,r19W(t))T
niW(t)
noise of measurement riW(t)
nW(t) noise vector of the measurement by an LRF; nW(t)=(n1W(t),n2W(t),,n19W(t))T
NB number of ultrasonic beacons; in this study, NB = 4
riB(t)
range from a robot to an ultrasonic beacon
zB(t) vector of the range data from a robot to the ultrasonic beacons; zB(t)=(r1B(t),r2B(t),r3B(t),r4B(t))T
niB(t)
noise of measurement riB(t)
nB (t) noise vector of the measurements by ultrasonic beacons; nB(t)=(n1B(t),,n4B(t))T
Next number of all exteroceptive range measurement data; Next = NW + NB = 23
z(t) exteroceptive measurement data encompassing the range data zW(t) and zB(t); z(t)=(zB(t),zW(t))T=(r1B(t),,r4B(t),r1W(t),,r19W(t))T=(r1(t),,r23(t))T
n(t) vector of exteroceptive measurement noise nW(t) and nB(t); n(t)=(nB(t),nW(t))T=(n1B(t),,n4B(t),n1W(t),n19W(t))T=(n1(t),n23(t))T
xBi location of the i-th ultrasonic beacon; xBi = (xBi, yBi), i = 1, 2, 3, 4
xB location vector of all ultrasonic beacons; xB = (xB1, xB2, xB3, xB4)T
υ(t) linear (translational) velocity of a mobile robot at time t
ω(t) rotational velocity of a mobile robot at time t
u(t) robot velocity vector at time t; u(t) = (υ(t), ω(t))
nυ(t) noise of proprioceptive data υ(t)
nω(t) noise of proprioceptive data ω(t)
nu(t) noise vector of proprioceptive data u(t); nu(t) = (nυ(t), nω(t))T
Q(t) error covariance of exteroceptive measurement noise n(t)
M(t) error covariance of proprioceptive motion noise nu(t)
Σ(t) error covariance of state x(t) at time t
m map of the workspace that affects the LRF measurements
g(·) robot motion model that calculates the next robot pose from the current robot pose using linear and rotational velocities; x(ti) = g(u(t), x(ti−1))
h(·) measurement model that maps the robot pose onto the distance to the beacons and walls; z(t) = (h(x(t), xB, m)
Bj(t) sigma points of the predicted range to beacon Bj at time t
Bj(t) weighted mean of sigma points Bj (t)
SBj (t) weighted error covariance of the range data to beacon Bj
K(t) Kalman gain with which the difference between the predicted and actual measurements is multiplied to adjust the predicted pose into best estimation
Σx,z(t) cross-error covariance between the state and measurement
S(t) error covariance of the measurement