Merge pull request #51 from YoheiKakiuchi/hydro-devel-fix-velocity-limit

velocity limit is overwritten (hydro)
This commit is contained in:
Ioan A Sucan 2014-01-18 09:15:42 -08:00
commit 0be9d41d59
1 changed files with 5 additions and 1 deletions

View File

@ -951,6 +951,8 @@ protected:
boost::shared_ptr<Joint> pjoint(new Joint());
pjoint->limits.reset(new JointLimits());
pjoint->limits->velocity = 0.0;
pjoint->limits->effort = 0.0;
pjoint->parent_link_name = plink->name;
if( !!pdomjoint->getName() ) {
@ -1096,7 +1098,9 @@ protected:
//ROS_INFO("joint %s axis: %f %f %f",pjoint->name.c_str(),pjoint->axis.x,pjoint->axis.y,pjoint->axis.z);
pjoint->parent_to_joint_origin_transform = _poseMult(tatt,_poseFromMatrix(_ExtractFullTransform(pattfull->getLink())));
if (pjoint->limits->velocity == 0.0) {
pjoint->limits->velocity = pjoint->type == Joint::PRISMATIC ? 0.01 : 0.5f;
}
pchildlink.reset();
++numjoints;
}