findDistance method with proper math and yaml.example updated. Still need to find experimental value of meterperpixel