![]() |
Tesseract 0.28.4
|
Backend-neutral collision queries between implicit signed-distance shapes. More...
#include <tesseract/collision/implicit_sdf_collision_solver.h>#include <tesseract/geometry/geometries.h>#include <tesseract/geometry/impl/signed_distance_field.h>#include <algorithm>#include <array>#include <cmath>#include <limits>#include <stdexcept>#include <utility>Functions | |
| std::vector< ImplicitSDFContact > | tesseract::collision::collideImplicitSDF (const ImplicitSDFShape &shape0, const ImplicitSDFShape &shape1, const ImplicitSDFCollisionConfig &config={}) |
| Find contacts between two implicit signed-distance shapes. | |
| ImplicitSDFShape | tesseract::collision::makeImplicitSDFShape (const tesseract::geometry::Geometry &geometry, const Eigen::Isometry3d &pose) |
| Create a world-coordinate implicit representation of a supported Tesseract geometry. | |
Backend-neutral collision queries between implicit signed-distance shapes.
The multi-start optimization strategy is adapted from MuJoCo's SDF collision implementation: https://github.com/google-deepmind/mujoco/blob/main/src/engine/engine_collision_sdf.c MuJoCo is licensed under the Apache License, Version 2.0.
| std::vector< ImplicitSDFContact > tesseract::collision::collideImplicitSDF | ( | const ImplicitSDFShape & | shape0, |
| const ImplicitSDFShape & | shape1, | ||
| const ImplicitSDFCollisionConfig & | config = {} ) |
Find contacts between two implicit signed-distance shapes.
This adapts MuJoCo's multi-start SDF collision strategy: deterministic Halton seeds are optimized over the overlap of the shapes' margin-expanded AABBs using a composite collision objective and backtracking gradient descent. Contact distance and nearest points are then recovered by projecting the converged point onto both zero level sets.
| shape0 | First implicit shape |
| shape1 | Second implicit shape |
| config | Solver configuration |
shape0 toward shape1 | std::invalid_argument | If either shape or any solver configuration value is invalid |
| ImplicitSDFShape tesseract::collision::makeImplicitSDFShape | ( | const tesseract::geometry::Geometry & | geometry, |
| const Eigen::Isometry3d & | pose ) |
Create a world-coordinate implicit representation of a supported Tesseract geometry.
Supported geometries are box, sphere, cylinder, cone, capsule, and signed distance field. This adapter is backend-neutral and is used by the FCL and Bullet backends; a backend may instead wrap its own distance representation in an ImplicitSDFShape and call collideImplicitSDF.
| geometry | Geometry to represent |
| pose | Geometry pose in world coordinates |
| std::invalid_argument | If the pose or supported geometry data is invalid, or if an SDF has nonuniform scale |