#include <span>
#include <vector>
#include <Eigen/Core>
#include <moveit_pro_base/robot_model/joint_model_group.hpp>
#include <moveit_pro_base/robot_model/link_model.hpp>
#include <moveit_pro_base/robot_state/robot_state.hpp>
|
| Eigen::VectorXd | cartesian_planning::sdfRepulsionTask (const moveit_pro::base::distance_field::DistanceField &sdf, moveit_pro::base::RobotState &fk_state, const moveit_pro::base::JointModelGroup &group, const Eigen::VectorXd ¤t_joint_values, std::span< const SdfControlPoint > control_points, const SdfRepulsionParameters ¶ms) |
| | Compute a nullspace joint-space nudge that pushes each control-point sphere away from the nearest obstacle in sdf.
|
| |