ompl#

OMPL submodule

class mplib.pymp.planning.ompl.FixedJoint#

Bases: pybind11_object

property articulation_idx#
property joint_idx#
property value#
class mplib.pymp.planning.ompl.OMPLPlanner#

Bases: pybind11_object

OMPL Planner

plan(self: mplib.pymp.planning.ompl.OMPLPlanner, start_state: numpy.ndarray[numpy.float64[m, 1]], goal_states: list[numpy.ndarray[numpy.float64[m, 1]]], planner_name: str = 'RRTConnect', time: float = 1.0, range: float = 0.0, fixed_joints: set[mplib::planning::ompl::FixedJointTpl<double>] = set(), no_simplification: bool = False, constraint_function: Callable[[numpy.ndarray[numpy.float64[m, 1]], numpy.ndarray[numpy.float64[m, 1], flags.writeable]], None] = None, constraint_jacobian: Callable[[numpy.ndarray[numpy.float64[m, 1]], numpy.ndarray[numpy.float64[m, 1], flags.writeable]], None] = None, constraint_tolerance: float = 0.001, verbose: bool = False) → tuple[str, numpy.ndarray[numpy.float64[m, n]]]#

Plan a path from start state to goal states.

Parameters:

  • start_state – start state of the movegroup joints

  • goal_states – list of goal states. Planner will stop when one of them is reached

  • planner_name – name of the planner pick between {RRTConnect, RRTstar}

  • time – planning time limit

  • range – planning range (for RRT family of planners and represents the maximum step size)

  • fixed_joints – list of fixed joints not considered in planning for this particular call

  • no_simplification – if True, the path will not be simplified (constained planning does not support simplification)

  • constraint_function – a R^d to R^1 function that evals to 0 when constraint is satisfied. Constraint ignored if fixed joints not empty

  • constraint_jacobian – the jacobian of the constraint w.r.t. the joint angles

  • constraint_tolerance – tolerance of what level of deviation from 0 is acceptable

  • verbose – print debug information. Default: False.

Returns:

pair of planner status and path. If planner succeeds, status is “Exact solution.”

simplify_path(self: mplib.pymp.planning.ompl.OMPLPlanner, path: numpy.ndarray[numpy.float64[m, n]]) → numpy.ndarray[numpy.float64[m, n]]#

Simplify the provided path.

Parameters:

path – path to be simplified (numpy array of shape (n, dim))

Returns:

simplified path