Skip to main content
. 2020 Apr 29;20(9):2544. doi: 10.3390/s20092544
bel(x) Belief of state
x[1,2,3,i] States of particle1, Particle 2, … Particle i
w[1,2,3,i] Weights of particle1, particle 2, … particle i
X¯k+1 State at sample time k + 1
K Timestamp
xk, yk Vehicle position in the x, y dimension at time k
vk Vehicles position in the x dimension at time k
θk Yaw angle at time k
θk(dt)˙, θ. Yaw rate of vehicle at time k
Δt, dt Sample time
Zk+1 Measurement vector at time k + 1
d[i] Distance of ego vehicle to ith beacon
Δθ[i] Relative angle of vehicle orientation and ith beacon
xb,i, yb,i Relative distance of vehicle and ith beacon
ϵd Noise distance measurement
ϵΔθ Noise of angle measurement
p(xi,yi) Multivariable normal distribution
σx, σy Covariance of sensor range noise in the x- and y-directions
xpaukf, k,aug State of PAUKF
wvelacc Noise of vehicle acceleration
wyawacc Noise of vehicle yaw acceleration
σvelacc Variance of noise of vehicle acceleration
σvelacc Variance of noise in vehicle yaw acceleration
Pk,aug Variance matrix of PAUKF.
Xpaukf, k+1,aug Augmented state with sigma points of PAUKF at time k + 1
μpaukf,k,aug Mean value of augmented state of PAUKF at time k
nx,aug Number of augmented states
wpaukf,i Weight of ith sigma point
λ Sigma point design parameter
x¯paukf,k+1|k Predicted state based on the weight of sigma points and states
P¯k+1|k Predicted variance based on sigma points and predicted state mean
ωpaukf,k+1 Measurement noise of PAUKF.
Zpaukf,k+1|k,i Measurement prediction based on sigma points.
Xpaukf,k+1|k,i Sigma points of state
A Measurement transition model.
zpaukf,k+1|k Predicted measurement based on sigma points and weights
Sk+1|k Predicted measurement covariance matrix.
R Variance matrix of the measurement noise.
σxpf Covariance of PF estimation in the x dimension
σypf Covariance of PF estimation in the y-dimension
Tk+1|k Cross-correlation matrix of PAUKF
Kk+1|k Kalman gain of PAUKF
x^PAUFK Final state estimation of PAUKF.
P^PAUFK Final state variance matrix of PAUKF