klampt.plan.robotplanning module

Functions:

makeSpace(world, robot[, …])

Creates a standard CSpace instance for the robot moving in the given world.

planToCartesianObjective(world, robot, iktargets)

Plans a path to reach one or more IK targets.

planToConfig(world, robot, target[, …])

Creates a MotionPlan object that can be called to solve a standard motion planning problem for a robot in a world.

planToSet(world, robot, target[, …])

Creates a MotionPlan object that can be called to solve a standard motion planning problem for a robot in a world.

preferredPlanOptions(robot[, movingSubset, …])

Returns some options that might be good for your given robot, and whether you want a feasible or just an optimal plan.

wizard(world_or_space_or_plan[, …])

Launches a “wizard” to help set up or debug a planner.

klampt.plan.robotplanning.makeSpace(world, robot, edgeCheckResolution=0.01, extraConstraints=[], equalityConstraints=[], equalityTolerance=0.001, ignoreCollisions=[], movingSubset=None)[source]

Creates a standard CSpace instance for the robot moving in the given world.

Parameters
  • world (WorldModel) – the world in which the robot lives, including obstacles.

  • robot (RobotModel) – the moving robot

  • edgeCheckResolution (float, optional) – the resolution at which edges in the path are checked for feasibility

  • extraConstraints (list, optional) –

    possible extra constraint functions, each of which needs to return True if satisfied.

    Note

    Don’t put cartesian constraints here! Instead place your function in equalityConstraints.

  • equalityConstraints (list, optional) – a list of IKObjectives or equality constraints f(x)=0 that must be satisfied during the motion. Equality constraints may return a float or a list of floats. In the latter case, this is interpreted as a vector function, in which all entries of the vector must be 0.

  • equalityTolerance (float, optional) – a tolerance to which all the equality constraints must be satisfied.

  • ignoreCollisions (list) – a list of ignored collisions. Each element may be a body in the world, or a pair (a,b) where a, b are bodies in the world.

  • movingSubset (optional) – if None, ‘all’, or ‘auto’ (default), all joints will be allowed to move. If this is a list, then only these joint indices will be allowed to move.

Returns

a C-space instance that describes the robot’s feasible space.

This can be used for planning by creating a cspace.MotionPlan object. Note that if an EmbeddedCSpace is returned, you should create a SubsetMotionPlan for greater convenience.

Return type

CSpace

klampt.plan.robotplanning.planToCartesianObjective(world, robot, iktargets, iktolerance=0.001, extraConstraints=[], equalityConstraints=[], equalityTolerance=0.001, ignoreCollisions=[], movingSubset=None, **planOptions)[source]

Plans a path to reach one or more IK targets.

Parameters
  • world (WorldModel) – same as planToConfig

  • iktargets (list of IKObjective) – a list of IKObjective instances (see the ik module)

  • iktolerance (float) – a tolerance to which the ik objectives must be satisfied

Returns

a planner instance that can be called to get a kinematically-feasible plan. (see MotionPlan.planMore() )

The underlying configuration space (a RobotCSpace, ClosedLoopRobotCSpace, or EmbeddedRobotCSpace) can be retrieved using the “space” attribute of the resulting MotionPlan object.

Return type

MotionPlan

klampt.plan.robotplanning.planToConfig(world, robot, target, edgeCheckResolution=0.01, extraConstraints=[], equalityConstraints=[], equalityTolerance=0.001, ignoreCollisions=[], movingSubset='auto', verbose=True, **planOptions)[source]

Creates a MotionPlan object that can be called to solve a standard motion planning problem for a robot in a world. The plan starts from the robot’s current configuration and ends in a target configuration.

Parameters
  • world (WorldModel) – the world in which the robot lives, including obstacles

  • robot (RobotModel) – the moving robot. The plan start configuration is the robot’s current configuration robot.getConfig().

  • target (list of float) – the desired final configuration of the robot.

  • edgeCheckResolution (float, optional) – the resolution at which edges in the path are checked for feasibility

  • extraConstraints (list, optional) –

    possible extra constraint functions, each of which needs to return True if satisfied.

    Note

    Don’t put cartesian constraints here! Instead place your function in equalityConstraints.

  • equalityConstraints (list, optional) – a list of IKObjectives or equality constraints f(x)=0 that must be satisfied during the motion. Equality constraints may return a float or a list of floats. In the latter case, this is interpreted as a vector function, in which all entries of the vector must be 0.

  • equalityTolerance (float, optional) – a tolerance to which all the equality constraints must be satisfied.

  • ignoreCollisions (list) – a list of ignored collisions. Each element may be a body in the world, or a pair (a,b) where a, b are bodies in the world.

  • movingSubset (optional) – if ‘auto’ (default), only the links that are different between the robot’s current config and target config will be allowed to move. Otherwise, if this is None or ‘all’, all joints will be allowed to move. If this is a list, then only these joint indices will be allowed to move.

  • planOptions (keywords) – keyword options that will be sent to the planner. See the documentation for MotionPlan.setOptions for more details.

Returns

a planner instance that can be called to get a kinematically-feasible plan. (see MotionPlan.planMore())

The underlying configuration space (a RobotCSpace, ClosedLoopRobotCSpace, or EmbeddedRobotCSpace) can be retrieved using the “space” attribute of the resulting MotionPlan object.

Return type

MotionPlan

klampt.plan.robotplanning.planToSet(world, robot, target, edgeCheckResolution=0.01, extraConstraints=[], equalityConstraints=[], equalityTolerance=0.001, ignoreCollisions=[], movingSubset=None, **planOptions)[source]

Creates a MotionPlan object that can be called to solve a standard motion planning problem for a robot in a world. The plan starts from the robot’s current configuration and ends in a target set.

Parameters
  • world (WorldModel) – the world in which the robot lives, including obstacles

  • robot (RobotModel) – the moving robot. The plan starts from robot.getConfig()

  • target (function or CSpace) –

    a function f(q) returning a bool which is True if the configuration q is a goal, OR an instance of a CSpace subclass where sample() generates a sample in the target set and feasible(x) tests whether a sample is in the target set.

    Note

    The function should accept vectors of the same dimensionality as the robot, not the moving subset. Similarly, the CSpace should have the same dimensionality as the robot.

  • edgeCheckResolution (float, optional) – the resolution at which edges in the path are checked for feasibility

  • extraConstraints (list, optional) –

    possible extra constraint functions, each of which needs to return True if satisfied.

    Note

    Don’t put cartesian constraints here! Instead place your function in equalityConstraints.

  • equalityConstraints (list, optional) – a list of IKObjectives or equality constraints f(x)=0 that must be satisfied during the motion. Equality constraints may return a float or a list of floats. In the latter case, this is interpreted as a vector function, in which all entries of the vector must be 0.

  • equalityTolerance (float, optional) – a tolerance to which all the equality constraints must be satisfied.

  • ignoreCollisions (list) – a list of ignored collisions. Each element may be a body in the world, or a pair (a,b) where a, b are bodies in the world.

  • movingSubset (optional) – if ‘auto’, ‘all’, or None (default), all joints will be allowed to move. If this is a list, then only these joint indices will be allowed to move.

  • planOptions (keywords) – keyword options that will be sent to the planner. See the documentation for MotionPlan.setOptions for more details.

Returns

a planner instance that can be called to get a kinematically-feasible plan. (see MotionPlan.planMore() )

The underlying configuration space (a RobotCSpace, ClosedLoopRobotCSpace, or EmbeddedRobotCSpace) can be retrieved using the “space” attribute of the resulting MotionPlan object.

Return type

MotionPlan

klampt.plan.robotplanning.preferredPlanOptions(robot, movingSubset=None, optimizing=False)[source]

Returns some options that might be good for your given robot, and whether you want a feasible or just an optimal plan.

TODO: base this off of info about the robot, such as dimensionality, joint ranges, etc.

klampt.plan.robotplanning.wizard(world_or_space_or_plan, moving_object=None, draw_end_effectors=None, draw_infeasible=False, debug_plan_time=30)[source]

Launches a “wizard” to help set up or debug a planner. The wizard will allow you to configure the planner, including the group of moving joints, start and terminal sets, and collision detection settings.

The return value is a configured MotionPlan object, ready to be launched.

The wizard will also allow you to get a Python string that sets up the space and/or invokes the planner.

Parameters
  • world_or_space_or_plan (WorldModel, CSpace, or MotionPlan) – the world containing the moving robot, or the currently configured CSpace or MotionPlan.

  • moving_object (RobotModel or RigidObjectModel, optional) – if world_or_space_or_plan is a WorldModel, this is the moving object for which you’d like to plan. By default, robot 0 is moving.

  • draw_end_effectors (list, optional) – if provided, initializes the links to be drawn in the motion plan debugger.

  • draw_infeasible (bool, optional) – initializes whether the motion plan debugger will show infeasible configurations

  • debug_plan_time (float, optional) – initializes the planning time in the motion plan debugger.

Returns

a properly configured MotionPlan object that can be called to get a motion plan. (see MotionPlan.planMore()).

Return type

MotionPlan