Controls
Presets
Parameters
Model checks
The science
Problem. An assembly robot knows the hole position only up to a Gaussian pose error: h ~ N(0, Σ) with Σ = R(φ) diag(σx², σy²) R(φ)T (the belief ellipse; the dashed rings are 1, 2, 3 σ). The peg cannot see the hole, so it presses lightly on the surface and slides until the funnel (chamfer) around the hole catches it, which is detected when |peg − h| ≤ c.
Spiral search. The commanded path is an Archimedean spiral r = bθ, b = p/(2π), travelled at constant speed v. Its exact arc length is s(θ) = (b/2)(θ√(1+θ²) + asinh θ), so the peg reaches radius r at time s(r/b)/v. A hole at distance ρ = |h| can only be caught while ρ−c ≤ r ≤ ρ+c, which brackets every detection time. Neighbouring turns are p apart and the capture band is 2c wide, so the spiral leaves no gap if p ≤ 2c; for larger pitch the covered fraction is 2c/p. When a pass reaches 3.5σ without contact a new pass starts with a radial offset and a 30 % larger radius (the belief tail is explored next).
Funnel insertion (Coulomb wedge model). Inside the funnel the chamfer converts part of the pressing force into a sideways force that centres the peg. With chamfer half-angle α and friction coefficient μ the peg slides in if μ < tan α (the friction cone is narrower than the chamfer) and wedges otherwise. μ is drawn per attempt uniformly from [μ0/2, 3μ0/2], so the per-attempt success probability is p = clamp((tan α − μ0/2)/μ0, 0, 1) and the number of attempts is geometric, capped at 10: mean (1 − (1−p)10)/p.
Force limit. The press force is reduced to Fe = min(Fp, Flim/√(1+(1.5μ0)²)) so that normal plus friction force never exceeds the limit during search. When the peg wedges the force rises to Fe√(1+μ²) μ/tan α; if that exceeds the limit the controller retreats after 0.4 s (force trip), otherwise after a 1.5 s timeout, then lifts and re-presses with a fresh friction sample.
Checks on this page. (1) numerically integrated spiral detection times against the closed-form arc-length bracket, (2) Monte Carlo CDF of the hole distance against quadrature of the Gaussian ellipse, (3) attempt statistics against the capped geometric law, (4) spiral coverage against min(1, 2c/p), (5) time-step independence, (6) force-limit invariant and the share of jams that trip the limit against a quadrature.
Simplifications. Planar search with a point-like contact; no peg tilt dynamics, no two-point-contact jamming geometry (the real wedge/jam analysis is Whitney 1982), no arm compliance, no sensor noise, constant friction within an attempt and a uniform friction spread. The funnel is idealised as a circle of capture radius c. Spiral search is a standard strategy in compliant assembly (see Chhatpar & Branicky 2001 for a stochastic variant).