geometry
Pure-math perception/planning geometry as in-process typed tools, from
mask back-projection through OBB fitting to grasp-candidate generation,
plus the two scalar helpers (geometry.iou, geometry.pose_distance).
Fully CPU — no model weights, no GPU.
When to use
- Turning a segmentation mask + depth + camera calibration into world-frame
points (
mask_to_world_points) and an object OBB (filter_and_compute_obb). - Deriving grasp poses from an OBB:
top_down_grasp_candidatesfor tabletop pick (feed the full list tocurobo.plan_to_grasp_posesas a goalset),front_grasp_from_obbfor horizontal interactions (drawer/door handles). - Building the collision world for the planner:
build_world_configwith the target's mask inobject_masksso the planner canignore_obstacle_namesit. - Estimating feature geometry for constrained mating: use
fit_planar_featurefor loops/openings andfit_linear_featurefor rods/pegs. Their axis signs are geometrically ambiguous, so pass a workcell- or camera-derivednormal_hint/axis_hintwhen direction matters.
Install
uv sync --extra geometry # open3d + scikit-learn (cv2/scipy come with gap core)
# (pip: pip install -e ".[geometry]")
The module imports lazily — the bundle loads (and the light tools work) without the extra; only OBB fitting, DBSCAN filtering and world reconstruction need open3d/sklearn/cv2.
Gotchas (carried over from the service)
- OBB
extentis HALF-extents (gap.types convention, same as the proto).compute_obbis upright-only: rotation is around world Z (no 3D tilt), and extents use the 2nd/98th percentile of points, not strict min/max. - Single-camera clouds are 2.5D: only camera-facing surfaces are observed, so
OBB centers carry a few cm of depth bias on opaque objects. (The service's
rehearsal-sandbox ground-truth snap that compensated for this in-container
was deliberately NOT ported — it depended on a
/appsandbox file.) - A fitted plane normal has two valid signs and a fitted line has two valid directions. The feature-fit tools expose hints solely to resolve that sign; callers must derive the hint from observed support geometry, camera viewing direction, or a declared workcell frame rather than an evaluator target.
top_down_grasp_candidatesdefaultz_offset=-0.04: fingertip 4 cm below the OBB top. Withz_offset=0.0the fingers close above the object (silent empty grip). Grasp Z is clamped to -0.05 m (table-clearance floor; LIBERO table top is at world z=0).mask_to_world_pointskeeps only depths in [0.015, 20.0] m (HyRL bounds); invalid/zero-depth pixels are dropped.filter_noisereturns the ORIGINAL cloud unchanged when DBSCAN labels everything noise (defensive fallback, mirrors HyRL).build_world_config: table removal only runs whentable_z_threshold != 0(typical -0.01); robot-point exclusion is Franka-only (simplified DH FK) and skips non-7-DOF joint states; prefer explicitobject_masksover thetarget_obbprojection fallback — masks are pixel-accurate, the OBB projection is a corner-AABB approximation inflated by 2 cm.top_down_grasp_from_obbyaw is NOT derived from the OBB — fingers may close across the wide axis; use the candidate fan when orientation matters.