Find contour working but not calibrated