This extended-kalman-filter implementation is leveraged from here.
rval is the update rate, set it as you needs.
You need to have pkg-config and opencv installed on your machine.
g++ -std=c++11 ekalman.cpp `pkg-config --cflags --libs opencv` -o kalman
