Darren Earl avatar Darren Earl committed 625fa8d

KDL discrepancy workaround

Comments (0)

Files changed (1)

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;
Tip: Filter by directory path e.g. /media app.js to search for public/media/app.js.
Tip: Use camelCasing e.g. ProjME to search for ProjectModifiedEvent.java.
Tip: Filter by extension type e.g. /repo .js to search for all .js files in the /repo directory.
Tip: Separate your search with spaces e.g. /ssh pom.xml to search for src/ssh/pom.xml.
Tip: Use ↑ and ↓ arrow keys to navigate and return to view the file.
Tip: You can also navigate files with Ctrl+j (next) and Ctrl+k (previous) and view the file with Ctrl+o.
Tip: You can also navigate files with Alt+j (next) and Alt+k (previous) and view the file with Alt+o.