demo_lidar failed purely because when i use kitti, i find depth associated with klt, using PnP to clac pose is very unrrliable; i think the depth associated is bad, so after do optimazition ,it also work bad;