Wrote a test function test_calib_multi_focus to test calibration of one camera for multiple focus distances and focal lentghs