Method to match color image and depth image using feature points