moveit.core.robot_state

Functions

robotStateToRobotStateMsg

Classes

RobotState

Representation of a robot's state.
class moveit.core.robot_state.RobotState

Representation of a robot’s state. At the lowest level, a state is a collection of variables. Each variable has a name and can have position, velocity, acceleration and effort associated to it. Effort and acceleration share the memory area for efficiency reasons (one should not set both acceleration and effort in the same state and expect things to work). Often variables correspond to joint names as well (joints with one degree of freedom have one variable), but joints with multiple degrees of freedom have more variables. Operations are allowed at variable level, joint level (see JointModel) and joint group level (see JointModelGroup). For efficiency reasons a state computes forward kinematics in a lazy fashion. This can sometimes lead to problems if the update() function was not called on the state.

clear_attached_bodies()

Clear all attached bodies. We only allow for attaching of objects via the PlanningScene instance. This method allows any attached objects that are associated to this RobotState instance to be removed.

property dirty

True if the robot state is dirty.

Type

bool

get_frame_transform()

Get the transformation matrix from the model frame (root of model) to the frame identified by frame_id. If frame_id was not found, frame_found is set to false and an identity transform is returned. This method is restricted to frames defined within the robot state and doesn’t include collision object present in the collision world. Please use the PlanningScene.getFrameTransform method for collision world objects.

Parameters

frame_id (str) – The id of the frame to get the transform for.

Returns

numpy.ndarray – The transformation matrix from the model frame to the frame identified by frame_id.

Returns the transform of the specified link in the global frame.

Parameters

link_name (str) – The name of the link to get the transform for.

Returns

numpy.ndarray – The transform of the specified link in the global frame.

get_jacobian()

Compute the Jacobian with reference to the last link of a specified group.

Parameters

  • joint_model_group_name (str) – The name of the joint model group to compute the Jacobian for.

  • reference_point_position (numpy.ndarray) – The position of the reference point in the link frame.

Returns

numpy.ndarray – The Jacobian of the specified group with respect to the reference point.

Raises

Exception – If the group is not a chain.

Compute the Jacobian with reference to a particular point on a given link, for a specified group.

Parameters

  • joint_model_group_name (str) – The name of the joint model group to compute the Jacobian for.

  • link_name (str) – The name of the link model to compute the Jacobian for.

  • reference_point_position (numpy.ndarray) – The position of the reference point in the link frame.

  • use_quaternion_representation (bool) – If true, the Jacobian will be represented using a quaternion representation, if false it defaults to euler angle representation.

Returns

numpy.ndarray – The Jacobian of the specified group with respect to the reference point.

get_joint_group_accelerations()

For a given group, get the acceleration values of the variables that make up the group.

Parameters

joint_model_group_name (str) – The name of the joint model group to copy the accelerations for.

Returns

numpy.ndarray – The accelerations of the joints in the joint model group.

get_joint_group_positions()

For a given group, get the position values of the variables that make up the group.

Parameters

joint_model_group_name (str) – The name of the joint model group to copy the positions for.

Returns

numpy.ndarray – The positions of the joints in the joint model group.

get_joint_group_velocities()

For a given group, get the velocity values of the variables that make up the group.

Parameters

joint_model_group_name (str) – The name of the joint model group to copy the velocities for.

Returns

numpy.ndarray – The velocities of the joints in the joint model group.

get_pose()

Get the pose of a link that is defined in the robot model.

Parameters

link_name (str) – The name of the link to get the pose for.

Returns

geometry_msgs.msg.Pose – A ROS geometry message containing the pose of the link.

property joint_accelerations
property joint_efforts
property joint_positions
property joint_velocities
property robot_model

The robot model instance associated to this robot state.

Type

moveit_py.core.RobotModel

set_from_ik()

Sets the state of the robot to the one that results from solving the inverse kinematics for the specified group.

Parameters

  • joint_model_group_name (str) – The name of the joint model group to set the state for.

  • geometry_pose (geometry_msgs.msg.Pose) – The pose of the end-effector to solve the inverse kinematics for.

  • tip_name (str) – The name of the link that is the tip of the end-effector.

  • timeout (float) – The amount of time to wait for the IK solution to be found.

set_joint_group_accelerations()

Sets the accelerations of the joints in the specified joint model group.

Parameters

  • joint_model_group_name (str) – The name of the joint model group to set the accelerations for.

  • acceleration_values (numpy.ndarray) – The accelerations of the joints in the joint model group.

set_joint_group_active_positions()

Sets the active positions of joints in the specified joint model group.

Parameters

  • joint_model_group_name (str) – The name of the joint model group to set the active positions for.

  • position_values (numpy.ndarray) – The positions of the joints in the joint model group.

set_joint_group_positions()

Sets the positions of the joints in the specified joint model group.

Parameters

  • joint_model_group_name (str)

  • position_values (numpy.ndarray) – The positions of the joints in the joint model group.

set_joint_group_velocities()

Sets the velocities of the joints in the specified joint model group.

Parameters

  • joint_model_group_name (str) – The name of the joint model group to set the velocities for.

  • velocity_values (numpy.ndarray) – The velocities of the joints in the joint model group.

set_to_default_values()

Set all joints to their default positions. The default position is 0, or if that is not within bounds then half way between min and max bound.

Set the joints in group to the position name defined in the SRDF.

Parameters

  • joint_model_group (moveit_py.core.JointModelGroup) – The joint model group to set the default values for.

  • name (str) – The name of a predefined state which is defined in the robot model SRDF.

Set the joints in group to the position name defined in the SRDF.

Parameters

  • joint_model_group_name (str) – The name of the joint model group to set the default values for.

  • name (str) – The name of a predefined state which is defined in the robot model SRDF.

set_to_random_positions()

Set all joints to random positions within the default bounds.

Set all joints in the joint model group to random positions within the default bounds.

Parameters

joint_model_group (moveit_py.core.JointModelGroup) – The joint model group to set the random values for.

property state_info
property state_tree

represents the state tree of the robot state.

Type

str

update()

Update state transforms.

Parameters

  • force (bool) – when true forces the update of the transforms from scratch.

  • category (str) – specifies the category to update. All indicates updating all transforms while “links_only” and “collisions_only” ensure that only links or collision transforms are updated.

moveit.core.robot_state.robotStateToRobotStateMsg()