![]() |
Tesseract 0.28.4
|
An implementation of the Optimized Forward Kinematic Tree as a stat solver. More...
#include <ofkt_state_solver.h>

Public Types | |
| using | Ptr = std::shared_ptr<OFKTStateSolver> |
| using | ConstPtr = std::shared_ptr<const OFKTStateSolver> |
| using | UPtr = std::unique_ptr<OFKTStateSolver> |
| using | ConstUPtr = std::unique_ptr<const OFKTStateSolver> |
| Public Types inherited from tesseract::scene_graph::MutableStateSolver | |
| using | Ptr = std::shared_ptr<MutableStateSolver> |
| using | ConstPtr = std::shared_ptr<const MutableStateSolver> |
| using | UPtr = std::unique_ptr<MutableStateSolver> |
| using | ConstUPtr = std::unique_ptr<const MutableStateSolver> |
| Public Types inherited from tesseract::scene_graph::StateSolver | |
| using | Ptr = std::shared_ptr<StateSolver> |
| using | ConstPtr = std::shared_ptr<const StateSolver> |
| using | UPtr = std::unique_ptr<StateSolver> |
| using | ConstUPtr = std::unique_ptr<const StateSolver> |
Public Member Functions | |
| OFKTStateSolver (const tesseract::scene_graph::SceneGraph &scene_graph, const std::string &prefix="") | |
| OFKTStateSolver (const tesseract::common::LinkId &root_link) | |
| OFKTStateSolver (const OFKTStateSolver &other) | |
| OFKTStateSolver & | operator= (const OFKTStateSolver &other) |
| OFKTStateSolver (OFKTStateSolver &&)=delete | |
| OFKTStateSolver & | operator= (OFKTStateSolver &&)=delete |
| void | setRevision (int revision) override final |
| Set the state solver revision number. | |
| int | getRevision () const override final |
| Get the state solver revision number. | |
| void | setState (const Eigen::Ref< const Eigen::VectorXd > &joint_values, const tesseract::common::JointIdTransformMap &floating_joint_values={}) override final |
| Set the current state of the solver. | |
| void | setState (const SceneState::JointValues &joint_values, const tesseract::common::JointIdTransformMap &floating_joint_values={}) override final |
| Set the current state using a JointId-keyed map. | |
| void | setState (const std::vector< tesseract::common::JointId > &joint_ids, const Eigen::Ref< const Eigen::VectorXd > &joint_values, const tesseract::common::JointIdTransformMap &floating_joint_values={}) override final |
| Set the current state using a vector of JointIds. | |
| void | setState (const tesseract::common::JointIdTransformMap &floating_joint_values) override final |
| Set the current state of the floating joint values. | |
| SceneState | getState (const Eigen::Ref< const Eigen::VectorXd > &joint_values, const tesseract::common::JointIdTransformMap &floating_joint_values={}) const override final |
| Get the state of the solver given the joint values. | |
| SceneState | getState (const SceneState::JointValues &joint_values, const tesseract::common::JointIdTransformMap &floating_joint_values={}) const override final |
| Get the state using a JointId-keyed map. | |
| SceneState | getState (const std::vector< tesseract::common::JointId > &joint_ids, const Eigen::Ref< const Eigen::VectorXd > &joint_values, const tesseract::common::JointIdTransformMap &floating_joint_values={}) const override final |
| Get the state using a vector of JointIds. | |
| SceneState | getState (const tesseract::common::JointIdTransformMap &floating_joint_values) const override final |
| Get the state given floating joint values. | |
| void | getLinkTransforms (tesseract::common::LinkIdTransformMap &link_transforms, const std::vector< tesseract::common::JointId > &joint_ids, const Eigen::Ref< const Eigen::VectorXd > &joint_values, const tesseract::common::JointIdTransformMap &floating_joint_values) const override final |
| Get the link transforms of the scene for a given set or subset of joint values. | |
| void | getLinkTransforms (tesseract::common::LinkIdTransformMap &link_transforms, const std::vector< tesseract::common::JointId > &joint_ids, const Eigen::Ref< const Eigen::VectorXd > &joint_values) const override final |
| Get link transforms without applying floating joint values. | |
| SceneState | getState () const override final |
| Get the current state of the scene. | |
| SceneState | getRandomState () const override final |
| Get the random state of the environment. | |
| Eigen::MatrixXd | getJacobian (const Eigen::Ref< const Eigen::VectorXd > &joint_values, const tesseract::common::LinkId &link_id, const tesseract::common::JointIdTransformMap &floating_joint_values={}) const override final |
| Get the jacobian for a link identified by LinkId. | |
| Eigen::MatrixXd | getJacobian (const std::vector< tesseract::common::JointId > &joint_ids, const Eigen::Ref< const Eigen::VectorXd > &joint_values, const tesseract::common::LinkId &link_id, const tesseract::common::JointIdTransformMap &floating_joint_values={}) const override final |
| Get the jacobian for a given set or subset of joint IDs. | |
| std::vector< tesseract::common::JointId > | getJointIds () const override final |
| Get the vector of joint IDs. | |
| std::vector< tesseract::common::JointId > | getFloatingJointIds () const override final |
| Get the vector of floating joint IDs. | |
| std::vector< tesseract::common::JointId > | getActiveJointIds () const override final |
| Get the vector of active joint IDs which align with the limits. | |
| tesseract::common::LinkId | getBaseLinkId () const override final |
| Get the base link ID. | |
| std::vector< tesseract::common::LinkId > | getLinkIds () const override final |
| Get the vector of link IDs. | |
| std::vector< tesseract::common::LinkId > | getActiveLinkIds () const override final |
| Get the vector of active link IDs. | |
| std::vector< tesseract::common::LinkId > | getStaticLinkIds () const override final |
| Get a vector of static link IDs. | |
| bool | isActiveLinkId (const tesseract::common::LinkId &link_id) const override final |
| Check if link is an active link. | |
| bool | hasLinkId (const tesseract::common::LinkId &link_id) const override final |
| Check if link id exists. | |
| tesseract::common::VectorIsometry3d | getLinkTransforms () const override final |
| Get all of the links transforms. | |
| Eigen::Isometry3d | getLinkTransform (const tesseract::common::LinkId &link_id) const override final |
| Get the transform corresponding to the link. | |
| Eigen::Isometry3d | getRelativeLinkTransform (const tesseract::common::LinkId &from_link_id, const tesseract::common::LinkId &to_link_id) const override final |
| Get transform between two links using the current state. | |
| tesseract::common::KinematicLimits | getLimits () const override final |
| Getter for kinematic limits. | |
| bool | addLink (const Link &link, const Joint &joint) override final |
| Adds a link/joint to the solver. | |
| bool | moveLink (const Joint &joint) override final |
| Move a link. | |
| bool | removeLink (const tesseract::common::LinkId &link_id) override final |
| Removes a link from the graph. | |
| bool | replaceJoint (const Joint &joint) override final |
| Replace and existing joint with the provided one. | |
| bool | removeJoint (const tesseract::common::JointId &joint_id) override final |
| Removes a joint from the graph. | |
| bool | moveJoint (const tesseract::common::JointId &joint_id, const tesseract::common::LinkId &parent_link_id) override final |
| Move joint to new parent link. | |
| bool | changeJointOrigin (const tesseract::common::JointId &joint_id, const Eigen::Isometry3d &new_origin) override final |
| Changes the "origin" transform of the joint and recomputes the associated edge. | |
| bool | changeJointPositionLimits (const tesseract::common::JointId &joint_id, double lower, double upper) override final |
| Changes the position limits associated with a joint. | |
| bool | changeJointVelocityLimits (const tesseract::common::JointId &joint_id, double limit) override final |
| Changes the velocity limits associated with a joint. | |
| bool | changeJointAccelerationLimits (const tesseract::common::JointId &joint_id, double limit) override final |
| Changes the acceleration limits associated with a joint. | |
| bool | changeJointJerkLimits (const tesseract::common::JointId &joint_id, double limit) override final |
| Changes the jerk limits associated with a joint. | |
| bool | insertSceneGraph (const SceneGraph &scene_graph, const Joint &joint, const std::string &prefix="") override final |
| Merge a scene into the current solver. | |
| StateSolver::UPtr | clone () const override final |
| This should clone the object so it may be used in a multi threaded application where each thread would clone the solver. | |
| Public Member Functions inherited from tesseract::scene_graph::MutableStateSolver | |
| MutableStateSolver (const MutableStateSolver &)=default | |
| MutableStateSolver & | operator= (const MutableStateSolver &)=default |
| MutableStateSolver (MutableStateSolver &&)=default | |
| MutableStateSolver & | operator= (MutableStateSolver &&)=default |
| Public Member Functions inherited from tesseract::scene_graph::StateSolver | |
| StateSolver (const StateSolver &)=default | |
| StateSolver & | operator= (const StateSolver &)=default |
| StateSolver (StateSolver &&)=default | |
| StateSolver & | operator= (StateSolver &&)=default |
Friends | |
| struct | ofkt_builder |
An implementation of the Optimized Forward Kinematic Tree as a stat solver.
Starke, S., Hendrich, N., & Zhang, J. (2018). A Forward Kinematics Data Structure for Efficient Evolutionary Inverse Kinematics. In Computational Kinematics (pp. 560-568). Springer, Cham.
|
finaloverridevirtual |
Set the state solver revision number.
| revision | The revision number to assign |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Get the state solver revision number.
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Set the current state of the solver.
This must be the same size and order as what is returned by getJointIds
| joint_values | The joint values |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Set the current state using a JointId-keyed map.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Set the current state using a vector of JointIds.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Set the current state of the floating joint values.
| floating_joint_values | The floating joint values to set |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the state of the solver given the joint values.
This must be the same size and order as what is returned by getJointIds
| joint_values | The joint values |
| floating_joint_values | The floating joint origin transform |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the state using a JointId-keyed map.
This does not change the internal state of the solver.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the state using a vector of JointIds.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the state given floating joint values.
| floating_joint_values | The floating joint values to leverage |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the link transforms of the scene for a given set or subset of joint values.
This is provided to optimize motion planning where link_transforms are poplated multiple time
This does not change the internal state of the solver.
This overwrites the transform of every link in the solver's tree but does not clear link_transforms first; keys from a different tree persist. Reusing a scratch map without clearing is safe iff every key later read is a link of this solver.
| link_transforms | The link_transforms to populate with data. |
| joint_ids | A list of joint IDs to change. |
| joint_values | The joint values |
| floating_joint_values | The floating joint origin transform |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get link transforms without applying floating joint values.
This is provided to optimize motion planning where link_transforms are poplated multiple time
This does not change the internal state of the solver.
This overwrites the transform of every link in the solver's tree but does not clear link_transforms first; keys from a different tree persist. Reusing a scratch map without clearing is safe iff every key later read is a link of this solver.
| link_transforms | The link_transforms to populate with data. |
| joint_ids | A list of joint IDs to change. |
| joint_values | The joint values |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the current state of the scene.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the random state of the environment.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the jacobian for a link identified by LinkId.
This must be the same size and order as what is returned by getJointIds
| joint_values | The joint values |
| link_id | The link ID to calculate the jacobian for |
| floating_joint_values | The floating joint origin transform |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the jacobian for a given set or subset of joint IDs.
This does not change the internal state of the solver.
| joint_ids | A list of joint IDs to change. |
| joint_values | The joint values |
| link_id | The link ID to calculate the jacobian for |
| floating_joint_values | The floating joint origin transform |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the vector of joint IDs.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the vector of floating joint IDs.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the vector of active joint IDs which align with the limits.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the base link ID.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the vector of link IDs.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the vector of active link IDs.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get a vector of static link IDs.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Check if link is an active link.
| link_id | The link id to check |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Check if link id exists.
| link_id | The link id to check for |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get all of the links transforms.
Order should be the same as getLinkIds()
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get the transform corresponding to the link.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Get transform between two links using the current state.
| from_link_id | The link id the transform should be relative to |
| to_link_id | The link id to get transform |
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Getter for kinematic limits.
Implements tesseract::scene_graph::StateSolver.
|
finaloverridevirtual |
Adds a link/joint to the solver.
| link | The link to be added to the graph |
| joint | The associated joint to be added to the graph |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Move a link.
| joint | The associated joint that defines the move |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Removes a link from the graph.
Note: this will remove all inbound and outbound edges
| link_id | Id of the link to be removed |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Replace and existing joint with the provided one.
| joint | The replacement joint |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Removes a joint from the graph.
| joint_id | Id of the joint to be removed |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Move joint to new parent link.
| joint_id | Id of the joint to move |
| parent_link_id | Id of parent link to move to |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Changes the "origin" transform of the joint and recomputes the associated edge.
| joint_id | Id of the joint to be changed |
| new_origin | The new transform associated with the joint |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Changes the position limits associated with a joint.
| joint_id | Id of the joint to be updated |
| limits | New position limits to be set as the joint limits @returnTrue if successful. |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Changes the velocity limits associated with a joint.
| joint_id | Id of the joint to be updated |
| limits | New velocity limits to be set as the joint limits |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Changes the acceleration limits associated with a joint.
| joint_id | Id of the joint to be updated |
| limits | New acceleration limits to be set as the joint limits |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Changes the jerk limits associated with a joint.
| joint_id | Id of the joint to be updated |
| limits | New jerk limits to be set as the joint limits |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
Merge a scene into the current solver.
| scene_graph | Const ref to the graph to be merged |
| joint | The joint that connects current scene with the inserted scene |
| prefix | string Will be prepended to every link and joint of the merged scene |
Implements tesseract::scene_graph::MutableStateSolver.
|
finaloverridevirtual |
This should clone the object so it may be used in a multi threaded application where each thread would clone the solver.
Implements tesseract::scene_graph::StateSolver.