Skip to content

Udacity Sensor Fusion Nanodegree Project 5 - Unscented Kalman Filter

Notifications You must be signed in to change notification settings

ohasanliUW/SFND_Unscented_Kalman_Filter

Folders and files

NameName
Last commit message
Last commit date

Latest commit

 

History

23 Commits
 
 
 
 
 
 
 
 
 
 
 
 

Repository files navigation

SFND_Unscented_Kalman_Filter

Sensor Fusion UKF Highway Project Starter Code

In this project you will implement an Unscented Kalman Filter to estimate the state of multiple cars on a highway using noisy lidar and radar measurements. Passing the project requires obtaining RMSE values that are lower that the tolerance outlined in the project rubric.

The main program can be built and ran by doing the following from the project top directory.

  1. mkdir build
  2. cd build
  3. cmake ..
  4. make ukf_highway
  5. ./src/ukf_highway

Note that the programs that need to be written to accomplish the project are src/ukf.cpp, and src/ukf.h

The program main.cpp has already been filled out, but feel free to modify it.

main.cpp is using highway.h to create a straight 3 lane highway environment with 3 traffic cars and the main ego car at the center. The viewer scene is centered around the ego car and the coordinate system is relative to the ego car as well. The ego car is green while the other traffic cars are blue. The traffic cars will be accelerating and altering their steering to change lanes. Each of the traffic car's has it's own UKF object generated for it, and will update each indidual one during every time step.

The red spheres above cars represent the (x,y) lidar detection and the purple lines show the radar measurements with the velocity magnitude along the detected angle. The Z axis is not taken into account for tracking, so you are only tracking along the X/Y axis.


Other Important Dependencies

Basic Build Instructions

  1. Clone this repo. git clone https://github.com/ohasanliUW/SFND_Unscented_Kalman_Filter.git
  2. Make a build directory: mkdir build && cd build
  3. Compile: cmake .. && make
  4. Run it: ./src/ukf_highway
  5. Run tests: ./tests/test

Unit Tests

tests directory has been introduced for unit tests with googletest framework. During the cmake configuration, googletest code is pulled automatically.

NIS for Radar and Lidar

To collect data for NIS, two file stream objects have been added to UKF class. In order to collect data reliable, only one car had been tracked. After collecting data, Microsoft Excell was used to plot the diagrams. Also, data were analysed manually to make sure 5th, 10th, 90th and 95th percentiles for both Lidar and Radar fall into expected NIS value table.

About

Udacity Sensor Fusion Nanodegree Project 5 - Unscented Kalman Filter

Resources

Stars

Watchers

Forks

Releases

No releases published

Packages

No packages published