#include <ros/ros.h>#include <urdf/model.h>#include <vector>#include <Eigen/Array>#include <kdl/frames.hpp>#include <kdl/jntarray.hpp>#include "frames.hpp"#include "jacobian.hpp"#include "src/Core/util/DisableMSVCWarnings.h"#include "src/Core/util/Macros.h"#include <cerrno>#include <cstdlib>#include <cmath>#include <complex>#include <cassert>#include <functional>#include <iosfwd>#include <cstring>#include <string>#include <limits>#include <climits>#include <algorithm>#include "src/Core/util/Constants.h"#include "src/Core/util/ForwardDeclarations.h"#include "src/Core/util/Meta.h"#include "src/Core/util/XprHelper.h"#include "src/Core/util/StaticAssert.h"#include "src/Core/util/Memory.h"#include "src/Core/NumTraits.h"#include "src/Core/MathFunctions.h"#include "src/Core/GenericPacketMath.h"#include "src/Core/arch/Default/Settings.h"#include "src/Core/Functors.h"#include "src/Core/DenseCoeffsBase.h"#include "src/Core/DenseBase.h"#include "src/Core/MatrixBase.h"#include "src/Core/EigenBase.h"#include "src/Core/Assign.h"#include "src/Core/util/BlasUtil.h"#include "src/Core/DenseStorage.h"#include "src/Core/NestByValue.h"#include "src/Core/ForceAlignedAccess.h"#include "src/Core/ReturnByValue.h"#include "src/Core/NoAlias.h"#include "src/Core/PlainObjectBase.h"#include "src/Core/Matrix.h"#include "src/Core/Array.h"#include "src/Core/CwiseBinaryOp.h"#include "src/Core/CwiseUnaryOp.h"#include "src/Core/CwiseNullaryOp.h"#include "src/Core/CwiseUnaryView.h"#include "src/Core/SelfCwiseBinaryOp.h"#include "src/Core/Dot.h"#include "src/Core/StableNorm.h"#include "src/Core/MapBase.h"#include "src/Core/Stride.h"#include "src/Core/Map.h"#include "src/Core/Block.h"#include "src/Core/VectorBlock.h"#include "src/Core/Transpose.h"#include "src/Core/DiagonalMatrix.h"#include "src/Core/Diagonal.h"#include "src/Core/DiagonalProduct.h"#include "src/Core/PermutationMatrix.h"#include "src/Core/Transpositions.h"#include "src/Core/Redux.h"#include "src/Core/Visitor.h"#include "src/Core/Fuzzy.h"#include "src/Core/IO.h"#include "src/Core/Swap.h"#include "src/Core/CommaInitializer.h"#include "src/Core/Flagged.h"#include "src/Core/ProductBase.h"#include "src/Core/Product.h"#include "src/Core/TriangularMatrix.h"#include "src/Core/SelfAdjointView.h"#include "src/Core/SolveTriangular.h"#include "src/Core/products/Parallelizer.h"#include "src/Core/products/CoeffBasedProduct.h"#include "src/Core/products/GeneralBlockPanelKernel.h"#include "src/Core/products/GeneralMatrixVector.h"#include "src/Core/products/GeneralMatrixMatrix.h"#include "src/Core/products/GeneralMatrixMatrixTriangular.h"#include "src/Core/products/SelfadjointMatrixVector.h"#include "src/Core/products/SelfadjointMatrixMatrix.h"#include "src/Core/products/SelfadjointProduct.h"#include "src/Core/products/SelfadjointRank2Update.h"#include "src/Core/products/TriangularMatrixVector.h"#include "src/Core/products/TriangularMatrixMatrix.h"#include "src/Core/products/TriangularSolverMatrix.h"#include "src/Core/products/TriangularSolverVector.h"#include "src/Core/BandMatrix.h"#include "src/Core/BooleanRedux.h"#include "src/Core/Select.h"#include "src/Core/VectorwiseOp.h"#include "src/Core/Random.h"#include "src/Core/Replicate.h"#include "src/Core/Reverse.h"#include "src/Core/ArrayBase.h"#include "src/Core/ArrayWrapper.h"#include "src/Core/GlobalFunctions.h"#include "src/Core/util/EnableMSVCWarnings.h"
Go to the source code of this file.
Namespaces | |
| namespace | arm_kinematics_constraint_aware |
Functions | |
| bool | arm_kinematics_constraint_aware::checkConstraintAwareIKService (kinematics_msgs::GetConstraintAwarePositionIK::Request &request, kinematics_msgs::GetConstraintAwarePositionIK::Response &response, const kinematics_msgs::KinematicSolverInfo &chain_info) |
| bool | arm_kinematics_constraint_aware::checkFKService (kinematics_msgs::GetPositionFK::Request &request, kinematics_msgs::GetPositionFK::Response &response, const kinematics_msgs::KinematicSolverInfo &chain_info) |
| bool | arm_kinematics_constraint_aware::checkIKService (kinematics_msgs::GetPositionIK::Request &request, kinematics_msgs::GetPositionIK::Response &response, const kinematics_msgs::KinematicSolverInfo &chain_info) |
| bool | arm_kinematics_constraint_aware::checkJointNames (const std::vector< std::string > &joint_names, const kinematics_msgs::KinematicSolverInfo &chain_info) |
| bool | arm_kinematics_constraint_aware::checkLinkName (const std::string &link_name, const kinematics_msgs::KinematicSolverInfo &chain_info) |
| bool | arm_kinematics_constraint_aware::checkLinkNames (const std::vector< std::string > &link_names, const kinematics_msgs::KinematicSolverInfo &chain_info) |
| bool | arm_kinematics_constraint_aware::checkRobotState (motion_planning_msgs::RobotState &robot_state, const kinematics_msgs::KinematicSolverInfo &chain_info) |
| double | arm_kinematics_constraint_aware::computeEuclideanDistance (const std::vector< double > &array_1, const KDL::JntArray &array_2) |
| bool | arm_kinematics_constraint_aware::convertPoseToRootFrame (const geometry_msgs::PoseStamped &pose_msg, geometry_msgs::PoseStamped &pose_msg_out, const std::string &root_frame, const tf::TransformListener &tf) |
| bool | arm_kinematics_constraint_aware::convertPoseToRootFrame (const geometry_msgs::PoseStamped &pose_msg, KDL::Frame &pose_kdl, const std::string &root_frame, const tf::TransformListener &tf) |
| double | arm_kinematics_constraint_aware::distance (const urdf::Pose &transform) |
| bool | arm_kinematics_constraint_aware::getChainInfo (const std::string &name, kinematics_msgs::KinematicSolverInfo &chain_info) |
| bool | arm_kinematics_constraint_aware::getChainInfoFromRobotModel (urdf::Model &robot_model, const std::string &root_name, const std::string &tip_name, kinematics_msgs::KinematicSolverInfo &chain_info) |
| int | arm_kinematics_constraint_aware::getJointIndex (const std::string &name, const kinematics_msgs::KinematicSolverInfo &chain_info) |
| bool | arm_kinematics_constraint_aware::getKDLChain (const std::string &xml_string, const std::string &root_name, const std::string &tip_name, KDL::Chain &kdl_chain) |
| void | arm_kinematics_constraint_aware::getKDLChainInfo (const KDL::Chain &chain, kinematics_msgs::KinematicSolverInfo &chain_info) |
| int | arm_kinematics_constraint_aware::getKDLSegmentIndex (const KDL::Chain &chain, const std::string &name) |
| bool | arm_kinematics_constraint_aware::getKDLTree (const std::string &xml_string, const std::string &root_name, const std::string &tip_name, KDL::Tree &kdl_chain) |
| Eigen::Matrix4f | arm_kinematics_constraint_aware::KDLToEigenMatrix (const KDL::Frame &p) |
| motion_planning_msgs::ArmNavigationErrorCodes | arm_kinematics_constraint_aware::kinematicsErrorCodeToMotionPlanningErrorCode (const int &kinematics_error_code) |
| bool | arm_kinematics_constraint_aware::loadRobotModel (ros::NodeHandle node_handle, urdf::Model &robot_model, std::string &root_name, std::string &tip_name, std::string &xml_string) |
| Eigen::Matrix4f | arm_kinematics_constraint_aware::matrixInverse (const Eigen::Matrix4f &g) |
| void | arm_kinematics_constraint_aware::reorderJointState (sensor_msgs::JointState &joint_state, const kinematics_msgs::KinematicSolverInfo &chain_info) |
| bool | arm_kinematics_constraint_aware::solveCosineEqn (const double &a, const double &b, const double &c, double &soln1, double &soln2) |
| bool | arm_kinematics_constraint_aware::solveQuadratic (const double &a, const double &b, const double &c, double *x1, double *x2) |