Shape_Model_2D/pm2d/_jit_kernels.py

"""Numba JIT kernels per hot-path del matching.

Fallback automatico a numpy se numba non disponibile o kernel fallisce.
"""
from __future__ import annotations

import numpy as np

try:
    import numba as nb
    HAS_NUMBA = True
except ImportError:  # pragma: no cover
    HAS_NUMBA = False


def _numpy_score_by_shift(
    resp: np.ndarray, dx: np.ndarray, dy: np.ndarray, bins: np.ndarray,
    bin_has_data: np.ndarray | None = None,
) -> np.ndarray:
    """Fallback numpy (stessa logica di LineShapeMatcher._score_by_shift)."""
    _, H, W = resp.shape
    acc = np.zeros((H, W), dtype=np.float32)
    n = len(dx)
    for i in range(n):
        b = int(bins[i])
        if bin_has_data is not None and not bin_has_data[b]:
            continue
        ddx = int(dx[i]); ddy = int(dy[i])
        y0s = max(0, -ddy); y1s = min(H, H - ddy)
        x0s = max(0, -ddx); x1s = min(W, W - ddx)
        if y0s >= y1s or x0s >= x1s:
            continue
        y0r = y0s + ddy; y1r = y1s + ddy
        x0r = x0s + ddx; x1r = x1s + ddx
        acc[y0s:y1s, x0s:x1s] += resp[b, y0r:y1r, x0r:x1r]
    if n > 0:
        acc /= n
    return acc


if HAS_NUMBA:

    @nb.njit(cache=True, parallel=True, fastmath=True, boundscheck=False)
    def _jit_score_by_shift(
        resp: np.ndarray,        # float32 (N_BINS, H, W)
        dx: np.ndarray,          # int32 (N,)
        dy: np.ndarray,          # int32 (N,)
        bins: np.ndarray,        # int8 (N,)
        bin_active: np.ndarray,  # bool_ (N_BINS,)
    ) -> np.ndarray:
        _, H, W = resp.shape
        N = dx.shape[0]
        acc = np.zeros((H, W), dtype=np.float32)
        for y in nb.prange(H):
            for i in range(N):
                b = bins[i]
                if not bin_active[b]:
                    continue
                ddy = dy[i]
                yy = y + ddy
                if yy < 0 or yy >= H:
                    continue
                ddx = dx[i]
                x_lo = 0 if ddx >= 0 else -ddx
                x_hi = W if ddx <= 0 else W - ddx
                for x in range(x_lo, x_hi):
                    acc[y, x] += resp[b, yy, x + ddx]
        if N > 0:
            inv = 1.0 / N
            for y in nb.prange(H):
                for x in range(W):
                    acc[y, x] *= inv
        return acc

    @nb.njit(cache=True, parallel=True, fastmath=True, boundscheck=False)
    def _jit_score_bitmap(
        spread: np.ndarray,      # uint8 (H, W), bit b = bin b attivo
        dx: np.ndarray,          # int32 (N,)
        dy: np.ndarray,          # int32 (N,)
        bins: np.ndarray,        # int8 (N,) bin per ogni feature
        bit_active: np.uint8,    # bitmask bin attivi in scena
    ) -> np.ndarray:
        """score[y,x] = (Σ_i [bit bins[i] acceso in spread[y+dy_i, x+dx_i]]) / N.

        32× meno memoria di response map float32 → cache-friendly.
        """
        H, W = spread.shape
        N = dx.shape[0]
        acc = np.zeros((H, W), dtype=np.float32)
        for y in nb.prange(H):
            for i in range(N):
                b = bins[i]
                mask = np.uint8(1) << b
                if (bit_active & mask) == 0:
                    continue
                ddy = dy[i]
                yy = y + ddy
                if yy < 0 or yy >= H:
                    continue
                ddx = dx[i]
                x_lo = 0 if ddx >= 0 else -ddx
                x_hi = W if ddx <= 0 else W - ddx
                for x in range(x_lo, x_hi):
                    if spread[yy, x + ddx] & mask:
                        acc[y, x] += 1.0
        if N > 0:
            inv = 1.0 / N
            for y in nb.prange(H):
                for x in range(W):
                    acc[y, x] *= inv
        return acc

    @nb.njit(cache=True, parallel=True, fastmath=True, boundscheck=False)
    def _jit_score_bitmap_greedy(
        spread: np.ndarray,
        dx: np.ndarray, dy: np.ndarray, bins: np.ndarray,
        bit_active: np.uint8,
        min_score: nb.float32,
        greediness: nb.float32,
    ) -> np.ndarray:
        """Score bitmap con early-exit greedy (no rescore background).

        Per ogni pixel iteriamo le N feature; abortiamo non appena diventa
        impossibile raggiungere `min_required` count anche aggiungendo
        tutte le feature rimanenti. min_required = greediness * min_score * N.

        greediness=0 → nessun early-exit (equivalente a kernel base).
        greediness=1 → exit non appena hits + remaining < min_score * N.
        Tipico: 0.7-0.9 → 2-4x speed-up senza perdere match.
        """
        H, W = spread.shape
        N = dx.shape[0]
        acc = np.zeros((H, W), dtype=np.float32)
        if N == 0:
            return acc
        min_req = greediness * min_score * N
        inv_N = nb.float32(1.0 / N)
        for y in nb.prange(H):
            for x in range(W):
                hits = 0
                for i in range(N):
                    b = bins[i]
                    mask = np.uint8(1) << b
                    if (bit_active & mask) == 0:
                        # Nessun chance per questa feature
                        if hits + (N - i - 1) < min_req:
                            break
                        continue
                    ddy = dy[i]
                    yy = y + ddy
                    if yy < 0 or yy >= H:
                        if hits + (N - i - 1) < min_req:
                            break
                        continue
                    ddx = dx[i]
                    xx = x + ddx
                    if xx < 0 or xx >= W:
                        if hits + (N - i - 1) < min_req:
                            break
                        continue
                    if spread[yy, xx] & mask:
                        hits += 1
                    else:
                        if hits + (N - i - 1) < min_req:
                            break
                acc[y, x] = nb.float32(hits) * inv_N
        return acc

    @nb.njit(cache=True, parallel=True, fastmath=True, boundscheck=False)
    def _jit_score_bitmap_rescored(
        spread: np.ndarray,      # uint8 (H, W)
        dx: np.ndarray,          # int32 (N,)
        dy: np.ndarray,          # int32 (N,)
        bins: np.ndarray,        # int8 (N,)
        bit_active: np.uint8,
        bg: np.ndarray,          # float32 (H, W) background density normalizzata
    ) -> np.ndarray:
        """score+rescore in un singolo pass: evita allocazione intermedia.

        Equivalente a:
            score = _jit_score_bitmap(...)
            out   = max(0, (score - bg) / (1 - bg + 1e-6))
        ma fonde la seconda passata dentro la normalizzazione finale
        (cache-friendly, risparmia ~15% sul totale find).
        """
        H, W = spread.shape
        N = dx.shape[0]
        acc = np.zeros((H, W), dtype=np.float32)
        for y in nb.prange(H):
            for i in range(N):
                b = bins[i]
                mask = np.uint8(1) << b
                if (bit_active & mask) == 0:
                    continue
                ddy = dy[i]
                yy = y + ddy
                if yy < 0 or yy >= H:
                    continue
                ddx = dx[i]
                x_lo = 0 if ddx >= 0 else -ddx
                x_hi = W if ddx <= 0 else W - ddx
                for x in range(x_lo, x_hi):
                    if spread[yy, x + ddx] & mask:
                        acc[y, x] += 1.0
        if N > 0:
            inv = 1.0 / N
            for y in nb.prange(H):
                for x in range(W):
                    v = acc[y, x] * inv
                    bgv = bg[y, x]
                    if bgv < 1.0:
                        r = (v - bgv) / (1.0 - bgv + 1e-6)
                        acc[y, x] = r if r > 0.0 else 0.0
                    else:
                        acc[y, x] = 0.0
        return acc

    @nb.njit(cache=True, parallel=True, fastmath=True, boundscheck=False)
    def _jit_popcount_density(spread: np.ndarray) -> np.ndarray:
        """Conta bit set per pixel: ritorna (H, W) float32 in [0..8]."""
        H, W = spread.shape
        out = np.zeros((H, W), dtype=np.float32)
        for y in nb.prange(H):
            for x in range(W):
                v = spread[y, x]
                # popcount manuale
                v = (v & 0x55) + ((v >> 1) & 0x55)
                v = (v & 0x33) + ((v >> 2) & 0x33)
                v = (v & 0x0F) + ((v >> 4) & 0x0F)
                out[y, x] = float(v)
        return out

    def _warmup():
        resp = np.zeros((8, 32, 32), dtype=np.float32)
        dx = np.zeros(1, dtype=np.int32)
        dy = np.zeros(1, dtype=np.int32)
        b = np.zeros(1, dtype=np.int8)
        ba = np.ones(8, dtype=np.bool_)
        _jit_score_by_shift(resp, dx, dy, b, ba)
        spread = np.zeros((32, 32), dtype=np.uint8)
        _jit_score_bitmap(spread, dx, dy, b, np.uint8(0xFF))
        bg = np.zeros((32, 32), dtype=np.float32)
        _jit_score_bitmap_rescored(spread, dx, dy, b, np.uint8(0xFF), bg)
        _jit_score_bitmap_greedy(
            spread, dx, dy, b, np.uint8(0xFF),
            np.float32(0.5), np.float32(0.8),
        )
        _jit_popcount_density(spread)

else:  # pragma: no cover

    def _jit_score_by_shift(resp, dx, dy, bins, bin_active):
        raise RuntimeError("numba non disponibile")

    def _jit_score_bitmap(spread, dx, dy, bins, bit_active):
        raise RuntimeError("numba non disponibile")

    def _jit_score_bitmap_rescored(spread, dx, dy, bins, bit_active, bg):
        raise RuntimeError("numba non disponibile")

    def _jit_score_bitmap_greedy(spread, dx, dy, bins, bit_active, min_score, greediness):
        raise RuntimeError("numba non disponibile")

    def _jit_popcount_density(spread):
        raise RuntimeError("numba non disponibile")

    def _warmup():
        pass


def score_bitmap(
    spread: np.ndarray, dx: np.ndarray, dy: np.ndarray, bins: np.ndarray,
    bit_active: int,
) -> np.ndarray:
    """Dispatch bitmap: JIT se numba, fallback numpy."""
    if HAS_NUMBA and len(dx) > 0:
        return _jit_score_bitmap(
            np.ascontiguousarray(spread, dtype=np.uint8),
            np.ascontiguousarray(dx, dtype=np.int32),
            np.ascontiguousarray(dy, dtype=np.int32),
            np.ascontiguousarray(bins, dtype=np.int8),
            np.uint8(bit_active),
        )
    # Fallback numpy (lento): converte bitmap a response 3D
    H, W = spread.shape
    resp = np.zeros((8, H, W), dtype=np.float32)
    for b in range(8):
        resp[b] = ((spread >> b) & 1).astype(np.float32)
    return _numpy_score_by_shift(resp, dx, dy, bins, None)


def score_bitmap_rescored(
    spread: np.ndarray, dx: np.ndarray, dy: np.ndarray, bins: np.ndarray,
    bit_active: int, bg: np.ndarray,
) -> np.ndarray:
    """Score bitmap + rescore fusi in un solo pass (JIT)."""
    if HAS_NUMBA and len(dx) > 0:
        return _jit_score_bitmap_rescored(
            np.ascontiguousarray(spread, dtype=np.uint8),
            np.ascontiguousarray(dx, dtype=np.int32),
            np.ascontiguousarray(dy, dtype=np.int32),
            np.ascontiguousarray(bins, dtype=np.int8),
            np.uint8(bit_active),
            np.ascontiguousarray(bg, dtype=np.float32),
        )
    # Fallback: chiamate separate
    score = score_bitmap(spread, dx, dy, bins, bit_active)
    out = (score - bg) / (1.0 - bg + 1e-6)
    return np.maximum(0.0, out).astype(np.float32)


def score_bitmap_greedy(
    spread: np.ndarray, dx: np.ndarray, dy: np.ndarray, bins: np.ndarray,
    bit_active: int, min_score: float, greediness: float,
) -> np.ndarray:
    """Score bitmap con early-exit greedy. Per coarse-pass aggressivo.

    Non applica rescore background: usare quando la scena ha basso clutter
    o quando si vuole mass-prune varianti via top-level rapidamente.
    """
    if HAS_NUMBA and len(dx) > 0:
        return _jit_score_bitmap_greedy(
            np.ascontiguousarray(spread, dtype=np.uint8),
            np.ascontiguousarray(dx, dtype=np.int32),
            np.ascontiguousarray(dy, dtype=np.int32),
            np.ascontiguousarray(bins, dtype=np.int8),
            np.uint8(bit_active),
            np.float32(min_score), np.float32(greediness),
        )
    # Fallback: kernel base senza early-exit
    return score_bitmap(spread, dx, dy, bins, bit_active)


def popcount_density(spread: np.ndarray) -> np.ndarray:
    if HAS_NUMBA:
        return _jit_popcount_density(np.ascontiguousarray(spread, dtype=np.uint8))
    # Fallback
    H, W = spread.shape
    out = np.zeros((H, W), dtype=np.float32)
    for b in range(8):
        out += ((spread >> b) & 1).astype(np.float32)
    return out


def score_by_shift(
    resp: np.ndarray, dx: np.ndarray, dy: np.ndarray, bins: np.ndarray,
    bin_has_data: np.ndarray | None = None,
) -> np.ndarray:
    """Dispatch: JIT se possibile, fallback numpy."""
    if not HAS_NUMBA or len(dx) == 0:
        return _numpy_score_by_shift(resp, dx, dy, bins, bin_has_data)
    # Normalizza tipi per Numba
    resp_f = np.ascontiguousarray(resp, dtype=np.float32)
    dx_i = np.ascontiguousarray(dx, dtype=np.int32)
    dy_i = np.ascontiguousarray(dy, dtype=np.int32)
    bins_i = np.ascontiguousarray(bins, dtype=np.int8)
    if bin_has_data is None:
        bin_active = np.ones(resp.shape[0], dtype=np.bool_)
    else:
        bin_active = np.ascontiguousarray(bin_has_data, dtype=np.bool_)
    return _jit_score_by_shift(resp_f, dx_i, dy_i, bins_i, bin_active)