imu aided klt tracking algorithm implemented in C++