Working Kitti GPS example in C++