Looping autofocus errors on failure to find focus. Test looping autofocus algorithm

tests/test_autofocus.py

@@ -0,0 +1,97 @@
+"""Tests for the autofoucs logic.
+
+This doesn't check the behaviour of the JPEG shaprness monitor.
+"""
+
+import pytest
+import numpy as np
+
+from openflexure_microscope_server.things.autofocus import (
+    AutofocusThing,
+    NoFocusFoundError,
+)
+
+
+def fake_sharpeness_data(
+    dz: int, start_z: int, max_loc: int, length: int = 41
+) -> tuple[list[float], np.ndarray, np.ndarray]:
+    """Create some fake data for the shapeness.
+
+    The highest returned sharpness is closest to max_loc
+    """
+    # Some fake timestamps
+    times = [i / 10 + 100000 for i in range(length)]
+    img_dz = dz / (length - 1)
+    heights = [round(start_z + i * img_dz) for i in range(length)]
+    # Shapeness is falls off linearly in this model.
+    sharpnesses = [10 * dz - abs(max_loc - h) for h in heights]
+    return times, np.array(heights), np.array(sharpnesses)
+
+
+@pytest.mark.parametrize(
+    ("start_z", "max_loc", "centre", "attempts_expected", "passes"),
+    [
+        # To complete the max must be in the central 1200, so -600 to 600 when looping
+        # from -1000 to 1000
+        (0, 550, True, 1, True),  # Found in loop1 from -1000 to 1000
+        (0, 650, True, 2, True),  # Just outside the limit in loop1
+        (0, 1300, True, 2, True),  # Found in loop2 from 0 to 2000
+        (0, 1300, False, 1, True),  # Found in loop1 from 0 to 2000 (as start="base")
+        (0, -1300, True, 2, True),  # Found in loop2 from 0 to 2000
+        (0, 7300, True, 8, True),  # Found in loop8 from 6000 to 8000
+        (0, 9300, True, 10, True),  # Found in loop10 from 8000 to 10000
+        (0, 9900, True, 10, False),  # Still not central in loop 10, doesn't pass
+    ],
+)
+def test_looping_autofocus(start_z, max_loc, centre, attempts_expected, passes, mocker):
+    """Test the high level looping autofocus algorithm."""
+    dz = 2000
+    # Make a mock stage where move_absolute abs and relative updates the position counter.
+    stage = mocker.Mock()
+    stage.position = {"x": 0, "y": 0, "z": start_z}
+
+    def set_pos(**kwargs: int) -> None:
+        """Move absolute should update position. So make a side effect for the mock."""
+        for axis, value in kwargs.items():
+            stage.position[axis] = value
+
+    def adjust_pos(**kwargs: int) -> None:
+        """Move relative should update position. So make a side effect for the mock."""
+        for axis, value in kwargs.items():
+            stage.position[axis] += value
+
+    stage.move_absolute.side_effect = set_pos
+    stage.move_relative.side_effect = adjust_pos
+
+    # Make a mock sharpness monitor that can generate sharpness data.
+    sharpness_monitor = mocker.MagicMock()
+    sharpness_monitor.focus_rel.return_value = (0, 0)
+
+    def return_shapness(*_args) -> tuple[list[float], np.ndarray, np.ndarray]:
+        """Generate shapenesses based on parameterised input, and mock stage position."""
+        return fake_sharpeness_data(
+            dz=dz,
+            start_z=stage.position["z"],
+            max_loc=max_loc,
+        )
+
+    sharpness_monitor.move_data.side_effect = return_shapness
+
+    autofocus_thing = AutofocusThing()
+    if passes:
+        autofocus_thing.looping_autofocus(
+            stage=stage,
+            sharpness_monitor=sharpness_monitor,
+            dz=dz,
+            start="centre" if centre else "base",
+        )
+    else:
+        with pytest.raises(NoFocusFoundError):
+            autofocus_thing.looping_autofocus(
+                stage=stage,
+                sharpness_monitor=sharpness_monitor,
+                dz=dz,
+                start="centre" if centre else "base",
+            )
+    assert sharpness_monitor.focus_rel.call_count == attempts_expected
+    assert abs(max_loc - stage.position["z"]) < dz / 40