|
Belief of state |
|
States of particle1, Particle 2, … Particle i |
|
Weights of particle1, particle 2, … particle i |
|
State at sample time k + 1 |
|
Timestamp |
,
|
Vehicle position in the x, y dimension at time k |
|
Vehicles position in the x dimension at time k |
|
Yaw angle at time k |
,
|
Yaw rate of vehicle at time k |
,
|
Sample time |
|
Measurement vector at time k + 1 |
|
Distance of ego vehicle to ith beacon |
|
Relative angle of vehicle orientation and ith beacon |
,
|
Relative distance of vehicle and ith beacon |
|
Noise distance measurement |
|
Noise of angle measurement |
|
Multivariable normal distribution |
,
|
Covariance of sensor range noise in the x- and y-directions |
|
State of PAUKF |
|
Noise of vehicle acceleration |
|
Noise of vehicle yaw acceleration |
|
Variance of noise of vehicle acceleration |
|
Variance of noise in vehicle yaw acceleration |
|
Variance matrix of PAUKF. |
|
Augmented state with sigma points of PAUKF at time k + 1 |
|
Mean value of augmented state of PAUKF at time k |
|
Number of augmented states |
|
Weight of ith sigma point |
|
Sigma point design parameter |
|
Predicted state based on the weight of sigma points and states |
|
Predicted variance based on sigma points and predicted state mean |
|
Measurement noise of PAUKF. |
|
Measurement prediction based on sigma points. |
|
Sigma points of state |
A |
Measurement transition model. |
|
Predicted measurement based on sigma points and weights |
|
Predicted measurement covariance matrix. |
|
Variance matrix of the measurement noise. |
|
Covariance of PF estimation in the x dimension |
|
Covariance of PF estimation in the y-dimension |
|
Cross-correlation matrix of PAUKF |
|
Kalman gain of PAUKF |
|
Final state estimation of PAUKF. |
|
Final state variance matrix of PAUKF |