In this project, my goal was to use the techniques and code examples presented in the Udacity course to estimate the position of a car using an Unsected Kalman Filter and provided Lidar/radar sensor data.
The goals / steps of this project are the following:
- Complete the UKF Algorithm
- Achieve a RSME value <[.09, .09, 0.65, 0.65], [0.20, 0.20, 0.55, 0.55] for datasets 1 & 2 respectively
- Use NIS for tuning
- Test Estimation RSME for Dataset 1
- Using only Radar data
- Using only Laser Data
- Comparision between EKF & UKF
After implementing the UKF algorithm, the NIS Values were used to tune and verify the process noise parameters (Std_a_ = 2 ; std_yawdd_ = 0.5). The final results of Dataset 1 yielded a 95% percentile of 7.34178 (Radar) & 5.10503 (Laser), which compared well to the desired values of 7.82 (Radar, n=3) & 5.99 (Laser, df =2). See below for a illustration of Dataset 1 run and its respective NIS.
The final results of Dataset 2 yielded a 95% percentile of 7.21353 (Radar) & 5.79358 (Laser), which compared well to the desired values of 7.82 (Radar, n=3) & 5.99 (Laser, df =2).. See below for a illustration of the run and its respective NIS.
From Dataset 1 - Laser UKF Only, achieved good position tracking accuracy, but not as good as the sensor fusion implementation.
From Dataset 1 - Radar UKF Only, achieved position tracking reasonably well, but not as good as the sensor fusion implementation or the Laser UKF Implementation. Which considering each sensor's Measurement noise, was the expected behavior.
From comparing EKF's results to the Final UKF results for Dataset 1, the performace was found to be greater as expected. This would be attributed to error introduced by the linealization approach in the EKF implementation and the use of the CRTV model which models the expected behavior of a car/bicycle better on turns.