Tesseract
Motion Planning Environment
|
#include <tesseract_common/macros.h>
#include <gtest/gtest.h>
#include <fstream>
#include "kinematics_test_utils.h"
#include "abb_irb2400_ikfast_kinematics.h"
#include <tesseract_kinematics/kdl/kdl_fwd_kin_chain.h>
Functions | |
pose | setIdentity () |
pose | translation ()[0] |
EXPECT_EQ (inv_kin->getSolverName(), IKFAST_INV_KIN_CHAIN_SOLVER_NAME) | |
EXPECT_EQ (inv_kin->numJoints(), 6) | |
EXPECT_EQ (inv_kin->getBaseLinkName(), base_link_name) | |
EXPECT_EQ (inv_kin->getTipLinkNames().size(), 1) | |
EXPECT_EQ (inv_kin->getTipLinkNames()[0], tip_link_name) | |
EXPECT_EQ (inv_kin->getJointNames(), joint_names) | |
EXPECT_TRUE (inv_kin2 !=nullptr) | |
EXPECT_EQ (inv_kin2->getSolverName(), IKFAST_INV_KIN_CHAIN_SOLVER_NAME) | |
EXPECT_EQ (inv_kin2->numJoints(), 6) | |
EXPECT_EQ (inv_kin2->getBaseLinkName(), base_link_name) | |
EXPECT_EQ (inv_kin2->getTipLinkNames().size(), 1) | |
EXPECT_EQ (inv_kin2->getTipLinkNames()[0], tip_link_name) | |
EXPECT_EQ (inv_kin2->getJointNames(), joint_names) | |
int | main (int argc, char **argv) |
Variables | |
Eigen::VectorXd | seed = Eigen::VectorXd::Zero(6) |
auto | scene_graph = getSceneGraphABB() |
std::string | manip_name = "manip" |
std::string | base_link_name = "base_link" |
std::string | tip_link_name = "tool0" |
std::vector< std::string > | joint_names { "joint_1", "joint_2", "joint_3", "joint_4", "joint_5", "joint_6" } |
auto | inv_kin = std::make_shared<AbbIRB2400Kinematics>(base_link_name, tip_link_name, joint_names) |
InverseKinematics::Ptr | inv_kin2 = inv_kin->clone() |
EXPECT_EQ | ( | inv_kin-> | getBaseLinkName(), |
base_link_name | |||
) |
EXPECT_EQ | ( | inv_kin-> | getJointNames(), |
joint_names | |||
) |
EXPECT_EQ | ( | inv_kin-> | getSolverName(), |
IKFAST_INV_KIN_CHAIN_SOLVER_NAME | |||
) |
EXPECT_EQ | ( | inv_kin-> | getTipLinkNames).size(, |
1 | |||
) |
EXPECT_EQ | ( | inv_kin-> | getTipLinkNames()[0], |
tip_link_name | |||
) |
EXPECT_EQ | ( | inv_kin-> | numJoints(), |
6 | |||
) |
EXPECT_EQ | ( | inv_kin2-> | getBaseLinkName(), |
base_link_name | |||
) |
EXPECT_EQ | ( | inv_kin2-> | getJointNames(), |
joint_names | |||
) |
EXPECT_EQ | ( | inv_kin2-> | getSolverName(), |
IKFAST_INV_KIN_CHAIN_SOLVER_NAME | |||
) |
EXPECT_EQ | ( | inv_kin2-> | getTipLinkNames).size(, |
1 | |||
) |
EXPECT_EQ | ( | inv_kin2-> | getTipLinkNames()[0], |
tip_link_name | |||
) |
EXPECT_EQ | ( | inv_kin2-> | numJoints(), |
6 | |||
) |
EXPECT_TRUE | ( | inv_kin2 ! | = nullptr | ) |
int main | ( | int | argc, |
char ** | argv | ||
) |
pose setIdentity | ( | ) |
pose translation | ( | ) |
std::string base_link_name = "base_link" |
runInvKinTest * inv_kin = std::make_shared<AbbIRB2400Kinematics>(base_link_name, tip_link_name, joint_names) |
runInvKinTest * inv_kin2 = inv_kin->clone() |
std::vector<std::string> joint_names { "joint_1", "joint_2", "joint_3", "joint_4", "joint_5", "joint_6" } |
std::string manip_name = "manip" |
KDLFwdKinChain fwd_kin* scene_graph = getSceneGraphABB() |
Eigen::VectorXd seed = Eigen::VectorXd::Zero(6) |
std::string tip_link_name = "tool0" |