from vins-fusion, only for test - View it on GitHub