Commits

Darren Earl  committed 625fa8d

KDL discrepancy workaround

  • Participants
  • Parent commits 352d01d

Comments (0)

Files changed (1)

File r2_controllers_gazebo/src/r2_impedance_controller.cpp

 	Eigen::VectorXd right_t = Eigen::VectorXd::Zero(jnt_size);
 	
 	
-	Wrenches wrenches( robot_tree.getNrOfSegments() );
+	Wrenches wrenches( robot_tree.getNrOfSegments() + 1 ); //KDL has a discrepancy between segments in SegmentMap (has an extra ) and getNrOfSegments, for now add one
 	vector<double> zeros( treeJnts.size() );
 	for( unsigned int x=0; x<treeJnts.size(); ++x )
 		zeros[x] = 0;