show

Visualize capsule approximation of rigid body tree

Since R2022b

Syntax

show(capapprox)

show(capapprox,config)

show(capapprox,Parent=ax)

ax = show(capapprox,___)

Description

show(capapprox) shows the collision capsule approximation capsapprox, superimposed on the original collision geometries of the corresponding rigid body tree in the home configuration of the rigid body tree.

show(capapprox,config) shows the collision capsule approximation superimposed on the original collision geometries of the corresponding rigid body tree with the specified joint configuration config.

show(capapprox,Parent=ax) specifies the parent axes handle ax to plot capsule-approximated rigid body tree.

ax = show(capapprox,___) returns the axes handle ax containing the capsule-approximated rigid body tree plot.

Examples

Create and Modify Capsule Approximation

Load a robot into the workspace and visualize it.

robotIRB = loadrobot("abbIrb120");
show(robotIRB);

Create a capsule approximation of the robot, and visualize the capsule-approximated robot model.

capsIRB = capsuleApproximation(robotIRB);
figure
show(capsIRB,homeConfiguration(capsIRB.RigidBodyTree));

Use the getCapsules function to see if the end effector, "tool0", has any collision capsules. Because tool0 is just a frame, it has no collision mesh to approximate as a collision capsule.

capsulesTool = getCapsules(capsIRB,"tool0")

capsulesTool =

  1x0 empty cell array

Add a capsule to tool0, at a position 0.15 meters along the x-axis, with a radius of 0.15 and a length of 0.

addCapsule(capsIRB,"tool0",[0.15 0],trvec2tform([0.15 0 0]))
show(capsIRB,homeConfiguration(capsIRB.RigidBodyTree));

Again check tool0 for a collision capsule, and verify the properties of the detected capsule.

capsulesTool = getCapsules(capsIRB,"tool0")

capsulesTool = 1x1 cell array
    {1x1 collisionCapsule}

capsulesTool{1}

ans = 
  collisionCapsule with properties:

    Radius: 0.1500
    Length: 0
      Pose: [4x4 double]

Remove the capsule from the base link. Then, reduce the collision capsule size of tool0, and move it -0.05 meters from the previous position along the x-axis.

removeCapsule(capsIRB,"base_link",1)
updatePose(capsIRB,"tool0",trvec2tform([-0.05 0 0]),1)
updateGeometry(capsIRB,"tool0",[.1 0.01],1)
show(capsIRB,homeConfiguration(capsIRB.RigidBodyTree));

Input Arguments

capapprox — Capsule approximation of rigid body tree

capsuleApproximation object

Capsule approximation of a rigid body tree, specified as a capsuleApproximation object.

config — Rigid body tree robot model configuration

n-element row vector

Rigid body tree robot model configuration, specified as an n-element row vector, in radians. n is the number of movable joints in the rigid body tree model.

Example: [pi 0 pi/2 0 0] is a configuration for a rigid body tree with five movable joints.

ax — Parent axes graphic handle

Axes object

Parent axes graphic handle, specified as an Axes object.

Output Arguments

ax — Axes graphic handle

Axes object

Axes graphic handle, returned as an Axes object.

Extended Capabilities

C/C++ Code Generation
Generate C and C++ code using MATLAB® Coder™.

Version History

Introduced in R2022b