Peg-in-Hole Spiral Search Under Pose Uncertainty

The same search on a workbench: a gripper-held peg spirals over the plate, the ghost socket marks the true hole. Drag to orbit.

Switch to 2D
Controls

Presets

Parameters

Quality

Camera

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).

Loading model...
Loading Blender model...
-
-
Made with 🟠 Blender · Three.js