Skip to content
Snippets Groups Projects
Commit 61a20239 authored by hyatt's avatar hyatt
Browse files

Commented out IK test code.

parent c37e18b3
Branches
Tags
No related merge requests found
......@@ -691,13 +691,13 @@ bool URKinematicsPlugin::searchPositionIK(const geometry_msgs::Pose &ik_pose,
error_code.val = error_code.SUCCESS;
if(error_code.val == error_code.SUCCESS) {
#if 0
std::vector<std::string> fk_link_names;
fk_link_names.push_back(ur_link_names_.back());
std::vector<geometry_msgs::Pose> fk_poses;
getPositionFK(fk_link_names, solution, fk_poses);
KDL::Frame kdl_fk_pose;
tf::poseMsgToKDL(fk_poses[0], kdl_fk_pose);
#if 0
printf("FK(solution) - pose \n");
for(int i=0; i<4; i++) {
for(int j=0; j<4; j++)
......
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment