Compare commits
1 Commits
| Author | SHA1 | Date | |
|---|---|---|---|
| 6704d66cd5 |
@@ -159,6 +159,63 @@ if HAS_NUMBA:
|
||||
acc[y, x] = 0.0
|
||||
return acc
|
||||
|
||||
@nb.njit(cache=True, parallel=True, fastmath=True, boundscheck=False)
|
||||
def _jit_top_max_per_variant(
|
||||
spread: np.ndarray, # uint8 (H, W)
|
||||
dx_flat: np.ndarray, # int32 (sum_N,)
|
||||
dy_flat: np.ndarray, # int32 (sum_N,)
|
||||
bins_flat: np.ndarray, # int8 (sum_N,)
|
||||
offsets: np.ndarray, # int32 (n_vars+1,) prefix sum
|
||||
bit_active: np.uint8,
|
||||
bg_per_variant: np.ndarray, # float32 (n_vars, H, W) - 1 per scala
|
||||
scale_idx: np.ndarray, # int32 (n_vars,) idx in bg_per_variant
|
||||
) -> np.ndarray:
|
||||
"""Batch: per ogni variante calcola max score (rescored bg), ritorna
|
||||
array float32 (n_vars,). Parallelismo prange ESTERNO sulle varianti
|
||||
elimina overhead di n_vars chiamate JIT separate (avg ~20us per
|
||||
chiamata su template piccoli) + pool thread Python.
|
||||
|
||||
Pensato per fase TOP del pruning quando n_vars >> n_threads.
|
||||
"""
|
||||
n_vars = offsets.shape[0] - 1
|
||||
H, W = spread.shape
|
||||
out = np.zeros(n_vars, dtype=np.float32)
|
||||
for vi in nb.prange(n_vars):
|
||||
i0 = offsets[vi]; i1 = offsets[vi + 1]
|
||||
N = i1 - i0
|
||||
if N == 0:
|
||||
out[vi] = -1.0
|
||||
continue
|
||||
si = scale_idx[vi]
|
||||
inv = nb.float32(1.0 / N)
|
||||
best = nb.float32(-1.0)
|
||||
for y in range(H):
|
||||
for x in range(W):
|
||||
s = nb.float32(0.0)
|
||||
for k in range(N):
|
||||
b = bins_flat[i0 + k]
|
||||
mask = np.uint8(1) << b
|
||||
if (bit_active & mask) == 0:
|
||||
continue
|
||||
ddy = dy_flat[i0 + k]
|
||||
yy = y + ddy
|
||||
if yy < 0 or yy >= H:
|
||||
continue
|
||||
ddx = dx_flat[i0 + k]
|
||||
xx = x + ddx
|
||||
if xx < 0 or xx >= W:
|
||||
continue
|
||||
if spread[yy, xx] & mask:
|
||||
s += nb.float32(1.0)
|
||||
s *= inv
|
||||
bgv = bg_per_variant[si, y, x]
|
||||
if bgv < 1.0:
|
||||
r = (s - bgv) / (1.0 - bgv + 1e-6)
|
||||
if r > best:
|
||||
best = r
|
||||
out[vi] = best if best > 0.0 else 0.0
|
||||
return out
|
||||
|
||||
@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]."""
|
||||
@@ -185,6 +242,12 @@ if HAS_NUMBA:
|
||||
_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)
|
||||
offsets = np.array([0, 1], dtype=np.int32)
|
||||
scale_idx = np.zeros(1, dtype=np.int32)
|
||||
bg_pv = np.zeros((1, 32, 32), dtype=np.float32)
|
||||
_jit_top_max_per_variant(
|
||||
spread, dx, dy, b, offsets, np.uint8(0xFF), bg_pv, scale_idx,
|
||||
)
|
||||
_jit_popcount_density(spread)
|
||||
|
||||
else: # pragma: no cover
|
||||
@@ -198,6 +261,12 @@ else: # pragma: no cover
|
||||
def _jit_score_bitmap_rescored(spread, dx, dy, bins, bit_active, bg):
|
||||
raise RuntimeError("numba non disponibile")
|
||||
|
||||
def _jit_top_max_per_variant(
|
||||
spread, dx_flat, dy_flat, bins_flat, offsets, bit_active,
|
||||
bg_per_variant, scale_idx,
|
||||
):
|
||||
raise RuntimeError("numba non disponibile")
|
||||
|
||||
def _jit_popcount_density(spread):
|
||||
raise RuntimeError("numba non disponibile")
|
||||
|
||||
@@ -246,6 +315,51 @@ def score_bitmap_rescored(
|
||||
return np.maximum(0.0, out).astype(np.float32)
|
||||
|
||||
|
||||
def top_max_per_variant(
|
||||
spread: np.ndarray,
|
||||
dx_list: list, dy_list: list, bin_list: list,
|
||||
bg_per_scale: dict,
|
||||
variant_scales: list,
|
||||
bit_active: int,
|
||||
) -> np.ndarray:
|
||||
"""Wrapper: prepara buffer flat e chiama kernel batch su tutte le varianti.
|
||||
|
||||
Parallelismo Numba prange-esterno sulle varianti (n_vars >> n_threads
|
||||
tipicamente per top-pruning) → meglio del thread-pool Python che paga
|
||||
overhead di n_vars chiamate JIT separate.
|
||||
"""
|
||||
if not HAS_NUMBA or len(dx_list) == 0:
|
||||
return np.array([], dtype=np.float32)
|
||||
n_vars = len(dx_list)
|
||||
sizes = [len(d) for d in dx_list]
|
||||
offsets = np.zeros(n_vars + 1, dtype=np.int32)
|
||||
offsets[1:] = np.cumsum(sizes)
|
||||
total = int(offsets[-1])
|
||||
dx_flat = np.empty(total, dtype=np.int32)
|
||||
dy_flat = np.empty(total, dtype=np.int32)
|
||||
bins_flat = np.empty(total, dtype=np.int8)
|
||||
for vi, (dx, dy, bn) in enumerate(zip(dx_list, dy_list, bin_list)):
|
||||
i0 = int(offsets[vi]); i1 = int(offsets[vi + 1])
|
||||
dx_flat[i0:i1] = dx
|
||||
dy_flat[i0:i1] = dy
|
||||
bins_flat[i0:i1] = bn
|
||||
# bg per variante: indicizzato per scala
|
||||
scales_unique = sorted(bg_per_scale.keys())
|
||||
scale_to_idx = {s: i for i, s in enumerate(scales_unique)}
|
||||
H, W = spread.shape
|
||||
bg_pv = np.empty((len(scales_unique), H, W), dtype=np.float32)
|
||||
for s, idx in scale_to_idx.items():
|
||||
bg_pv[idx] = bg_per_scale[s]
|
||||
scale_idx = np.array(
|
||||
[scale_to_idx[s] for s in variant_scales], dtype=np.int32,
|
||||
)
|
||||
return _jit_top_max_per_variant(
|
||||
np.ascontiguousarray(spread, dtype=np.uint8),
|
||||
dx_flat, dy_flat, bins_flat, offsets, np.uint8(bit_active),
|
||||
bg_pv, scale_idx,
|
||||
)
|
||||
|
||||
|
||||
def popcount_density(spread: np.ndarray) -> np.ndarray:
|
||||
if HAS_NUMBA:
|
||||
return _jit_popcount_density(np.ascontiguousarray(spread, dtype=np.uint8))
|
||||
|
||||
+22
-110
@@ -40,6 +40,7 @@ from pm2d._jit_kernels import (
|
||||
score_by_shift as _jit_score_by_shift,
|
||||
score_bitmap as _jit_score_bitmap,
|
||||
score_bitmap_rescored as _jit_score_bitmap_rescored,
|
||||
top_max_per_variant as _jit_top_max_per_variant,
|
||||
popcount_density as _jit_popcount,
|
||||
HAS_NUMBA,
|
||||
)
|
||||
@@ -393,108 +394,6 @@ class LineShapeMatcher:
|
||||
oy = float(np.clip(oy, -0.5, 0.5))
|
||||
return x + ox, y + oy
|
||||
|
||||
def _refine_pose_joint(
|
||||
self,
|
||||
spread0: np.ndarray,
|
||||
template_gray: np.ndarray,
|
||||
cx: float, cy: float,
|
||||
angle_deg: float, scale: float,
|
||||
mask_full: np.ndarray,
|
||||
max_iter: int = 24,
|
||||
tol: float = 1e-3,
|
||||
) -> tuple[float, float, float, float]:
|
||||
"""Refine congiunto (cx, cy, angle) via Nelder-Mead 3D.
|
||||
|
||||
Ottimizza simultaneamente posizione e angolo (vs golden search 1D
|
||||
sull'angolo poi quadratico 2D su xy che alterna assi). Halcon-style:
|
||||
un singolo iter LM stila il match a precisione sub-pixel + sub-step.
|
||||
Ritorna (angle, score, cx, cy) dove score e quello calcolato sulla
|
||||
scena spread (no template gray).
|
||||
"""
|
||||
h, w = template_gray.shape
|
||||
sw = max(16, int(round(w * scale)))
|
||||
sh = max(16, int(round(h * scale)))
|
||||
gray_s = cv2.resize(template_gray, (sw, sh), interpolation=cv2.INTER_LINEAR)
|
||||
mask_s = cv2.resize(mask_full, (sw, sh), interpolation=cv2.INTER_NEAREST)
|
||||
diag = int(np.ceil(np.hypot(sh, sw))) + 6
|
||||
py = (diag - sh) // 2; px = (diag - sw) // 2
|
||||
gray_p = cv2.copyMakeBorder(gray_s, py, diag - sh - py, px, diag - sw - px,
|
||||
cv2.BORDER_REPLICATE)
|
||||
mask_p = cv2.copyMakeBorder(mask_s, py, diag - sh - py, px, diag - sw - px,
|
||||
cv2.BORDER_CONSTANT, value=0)
|
||||
center = (diag / 2.0, diag / 2.0)
|
||||
H, W = spread0.shape
|
||||
|
||||
def _score(params: tuple[float, float, float]) -> float:
|
||||
ddx, ddy, dang = params
|
||||
ang = angle_deg + dang
|
||||
M = cv2.getRotationMatrix2D(center, ang, 1.0)
|
||||
gray_r = cv2.warpAffine(gray_p, M, (diag, diag),
|
||||
flags=cv2.INTER_LINEAR,
|
||||
borderMode=cv2.BORDER_REPLICATE)
|
||||
mask_r = cv2.warpAffine(mask_p, M, (diag, diag),
|
||||
flags=cv2.INTER_NEAREST, borderValue=0)
|
||||
mag, bins = self._gradient(gray_r)
|
||||
fx, fy, fb = self._extract_features(mag, bins, mask_r)
|
||||
if len(fx) < 8:
|
||||
return 0.0
|
||||
cxe = cx + ddx; cye = cy + ddy
|
||||
ix = int(round(cxe)); iy = int(round(cye))
|
||||
tot = 0
|
||||
valid = 0
|
||||
for i in range(len(fx)):
|
||||
xs = ix + int(fx[i] - center[0])
|
||||
ys = iy + int(fy[i] - center[1])
|
||||
if 0 <= xs < W and 0 <= ys < H:
|
||||
bit = np.uint8(1 << int(fb[i]))
|
||||
if spread0[ys, xs] & bit:
|
||||
tot += 1
|
||||
valid += 1
|
||||
return -float(tot) / max(1, valid) # minimize -score
|
||||
|
||||
# Nelder-Mead 3D inline (no scipy). Simplex iniziale: vertice + offset
|
||||
# dx=±0.5px, dy=±0.5px, dθ=±step/2.
|
||||
step_a = self.angle_step_deg / 2.0 if self.angle_step_deg > 0 else 1.0
|
||||
x0 = np.array([0.0, 0.0, 0.0])
|
||||
simplex = np.array([
|
||||
x0,
|
||||
x0 + [0.5, 0.0, 0.0],
|
||||
x0 + [0.0, 0.5, 0.0],
|
||||
x0 + [0.0, 0.0, step_a],
|
||||
])
|
||||
fvals = np.array([_score(tuple(s)) for s in simplex])
|
||||
for _ in range(max_iter):
|
||||
order = np.argsort(fvals)
|
||||
simplex = simplex[order]; fvals = fvals[order]
|
||||
if abs(fvals[-1] - fvals[0]) < tol:
|
||||
break
|
||||
centroid = simplex[:-1].mean(axis=0)
|
||||
xr = centroid + 1.0 * (centroid - simplex[-1])
|
||||
fr = _score(tuple(xr))
|
||||
if fvals[0] <= fr < fvals[-2]:
|
||||
simplex[-1] = xr; fvals[-1] = fr
|
||||
continue
|
||||
if fr < fvals[0]:
|
||||
xe = centroid + 2.0 * (centroid - simplex[-1])
|
||||
fe = _score(tuple(xe))
|
||||
if fe < fr:
|
||||
simplex[-1] = xe; fvals[-1] = fe
|
||||
else:
|
||||
simplex[-1] = xr; fvals[-1] = fr
|
||||
continue
|
||||
xc = centroid + 0.5 * (simplex[-1] - centroid)
|
||||
fc = _score(tuple(xc))
|
||||
if fc < fvals[-1]:
|
||||
simplex[-1] = xc; fvals[-1] = fc
|
||||
continue
|
||||
for k in range(1, 4):
|
||||
simplex[k] = simplex[0] + 0.5 * (simplex[k] - simplex[0])
|
||||
fvals[k] = _score(tuple(simplex[k]))
|
||||
best_i = int(np.argmin(fvals))
|
||||
ddx, ddy, dang = simplex[best_i]
|
||||
return (angle_deg + float(dang), -float(fvals[best_i]),
|
||||
cx + float(ddx), cy + float(ddy))
|
||||
|
||||
def _refine_angle(
|
||||
self,
|
||||
spread0: np.ndarray, # bitmap uint8 (H, W)
|
||||
@@ -676,7 +575,7 @@ class LineShapeMatcher:
|
||||
verify_threshold: float = 0.4,
|
||||
coarse_angle_factor: int = 2,
|
||||
scale_penalty: float = 0.0,
|
||||
refine_pose_joint: bool = False,
|
||||
batch_top: bool = False,
|
||||
) -> list[Match]:
|
||||
"""
|
||||
scale_penalty: se > 0, riduce lo score per match a scala diversa da 1.0:
|
||||
@@ -760,7 +659,25 @@ class LineShapeMatcher:
|
||||
|
||||
kept_coarse: list[tuple[int, float]] = []
|
||||
all_top_scores: list[tuple[int, float]] = []
|
||||
if self.n_threads > 1 and len(coarse_idx_list) > 1:
|
||||
# batch_top: usa kernel batch single-call con prange-esterno su
|
||||
# varianti. Vince su threadpool quando n_vars >> n_threads e quando
|
||||
# H*W top e' piccolo (overhead chiamate JIT > costo kernel).
|
||||
if (batch_top and HAS_NUMBA and len(coarse_idx_list) > 4):
|
||||
dx_l = []; dy_l = []; bn_l = []; vs_l = []
|
||||
for vi in coarse_idx_list:
|
||||
var = self.variants[vi]
|
||||
lvl = var.levels[min(top, len(var.levels) - 1)]
|
||||
dx_l.append(lvl.dx); dy_l.append(lvl.dy); bn_l.append(lvl.bin)
|
||||
vs_l.append(var.scale)
|
||||
scores_arr = _jit_top_max_per_variant(
|
||||
spread_top, dx_l, dy_l, bn_l, bg_cache_top, vs_l,
|
||||
bit_active_top,
|
||||
)
|
||||
for vi, best in zip(coarse_idx_list, scores_arr.tolist()):
|
||||
all_top_scores.append((vi, best))
|
||||
if best >= top_thresh:
|
||||
kept_coarse.append((vi, best))
|
||||
elif self.n_threads > 1 and len(coarse_idx_list) > 1:
|
||||
with ThreadPoolExecutor(max_workers=self.n_threads) as ex:
|
||||
for vi, best in ex.map(_top_score, coarse_idx_list):
|
||||
all_top_scores.append((vi, best))
|
||||
@@ -901,12 +818,7 @@ class LineShapeMatcher:
|
||||
var = self.variants[vi]
|
||||
ang_f = var.angle_deg
|
||||
score_f = score
|
||||
if refine_pose_joint and self.template_gray is not None:
|
||||
ang_f, score_f, cx_f, cy_f = self._refine_pose_joint(
|
||||
spread0, self.template_gray, cx_f, cy_f,
|
||||
var.angle_deg, var.scale, mask_full,
|
||||
)
|
||||
elif refine_angle and self.template_gray is not None:
|
||||
if refine_angle and self.template_gray is not None:
|
||||
ang_f, score_f, cx_f, cy_f = self._refine_angle(
|
||||
spread0, bit_active_full, self.template_gray, cx_f, cy_f,
|
||||
var.angle_deg, var.scale, mask_full,
|
||||
|
||||
Reference in New Issue
Block a user