Merge branch 'master' of github.com:corlab/rtt-gazebo-ur5-integration

merging
corlab · Jun 13, 2016 · afb8ee1 · afb8ee1
2 parents fc2dbba + 766a7dd
commit afb8ee1
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/src/ur5_rtt_gazebo_component.cpp b/src/ur5_rtt_gazebo_component.cpp
@@ -398,7 +398,7 @@ class UR5RttGazeboComponent: public RTT::TaskContext {
 
 		// Create vector containing awaited position.
 		RealVectorPtr inputdata = RealVector::create(elm->getInputDimension(), 0.0);
-		for (int j=0; j<inputdata->getDimension(); j++) inputdata->setValueEquals(j,target_value[j]);
+		for (int j=0; j<inputdata->getDimension(); j++) inputdata->setValueEquals(j,model->GetJoints()[joints_idx[j]]->GetAngle(0).Radian());
 
 		// Create vector containing the torque which should be applied.
 		RealVectorPtr result = elm->evaluate(inputdata);