make sur ewe use the right K
use the proper K_image/K_depth
switch to a C++ implementation of FeatureFinder, comply to K_image/K_depth