[ros-users] multi_dof_joints parameter in arm_navigation stack
Felix Messmer
felix_messmer at web.de
Tue Feb 8 08:55:05 UTC 2011
Dear Gil, dear Sachin,
thanks a lot for your help and the detailed explanation!
The Error referring to the floating_trans_x joint doesn't appear
anymore...thus, this seems to be fixed! Thanks!
However, I still get an Error message that says that the IK solution
doesn't obey the goal constraints and that joint limits are violated.
Although, the pose goal is right next to the care-o-bot and the (arm!)
IK-solution lies within the joint limits.
____________________________________________________________________________________________________________________________________________
[ INFO] [1297153951.402688697, 276.559000000]: Received new goal
[ INFO] [1297153951.440344878, 276.576000000]: Planning to a pose goal
[ INFO] [1297153951.440452615, 276.576000000]: IK request
[ INFO] [1297153951.440494169, 276.576000000]: link_name : base_link
[ INFO] [1297153951.440526016, 276.576000000]: frame_id : base_link
[ INFO] [1297153951.440560919, 276.576000000]: position :
(-0.055000,-0.754000,0.602000)
[ INFO] [1297153951.440597076, 276.576000000]: orientation :
(0.626000,-0.390000,0.651000,-0.178000)
[ INFO] [1297153951.440626177, 276.576000000]:
[ INFO] [1297153951.492602527, 276.592000000]: Link name arm_7_link
Position constraint satisfied: desired:: -0.055000, -0.754000, 0.602000,
current:: 2.306240, -0.754654, 2.724826, tolerance: 0.400000, 0.400000,
0.400000
[ WARN] [1297153951.492886546, 276.592000000]: State violates goal
constraints.
[ INFO] [1297153951.501037132, 276.596000000]: IK returned joint state
for goal that doesn't seem to be valid
[ WARN] [1297153951.501105392, 276.596000000]: IK solution doesn't obey
goal constraints
[ WARN] [1297153951.530798642, 276.603000000]: Joint limits violated.
[ERROR] [1297153951.541223194, 276.603000000]: Will not plan to
requested joint goal since it violates joint limits constraints
______________________________________________________________________________________________________________________________________________
I couldn't look into it more closely, since I'm busy doing something
else first.
But it seems that this is due to the cob's ik_solver. It currently
doesn't support all the services that the pr2_kinematics stack provides,
e.g. constraint_aware IK.
Maybe the planner expects some more information within the IK-response
that our ik_solver currently just doesn't provide.
I'll have a look at that as soon as possible and then get back to you!
Best regards,
Felix
On 2011-02-04 18:15, Gil Jones wrote:
> Hi Felix,
>
> As Sachin said, the bug you were seeing should be fixed. By way of
> explanation, we were trying to accomplish a few things with the multi-dof
> transform. The primary purpose is to supply a mechanism for a
world->robot
> transform that supplements the urdf, which doesn't and shouldn't really
> supply information about how to transform between a fixed world frame
and a
> frame for the movable base. The world transform should be either be a
3-dof
> Planar Joint with (x,y,th) or a 6-dof Floating Joint with a full
orientation
> matrix. We found on the PR2 that we had to use a floating joint as there
> can occasionally be enough of a pitch and roll in our IMU such that they
> need to be accounted for. It's entirely fine to do what you've done
below,
> which is to say that you essentially don't care about the fixed transform
> and will always be planning based on the current base position of the
> robot. So that should be all you need to do.
>
> Having a fixed reference transform should allow two important pieces of
> functionality - as you say, it should allow you to plan to move the base,
> and it should also allow you to pose the robot some where else in the
world
> and plan based on that new pose - for instance, you might be
interested to
> know whether an object across the room from the robot's current
location can
> be picked up given a particular approach pose. By specifying a new
> multi-dof transform in the start_state message our system should support
> such things, though it is not the case that our current planners fully
> support the former use-case.
>
> The other purpose of the multi-dof joints is to equip the system to
use tf
> transforms instead of just joint_state messages to populate the current
> position of the robot. The system is set up to first try to set multi-dof
> joints from individually labeled entries in the joint state and then
to use
> tf to get a pose transform for the entire joint if it needs to. The
message
> you are seeing refers to one of the labeled single dofs -
'floating_trans_x'
> - of the multi-dof joint 'base_joint'. The bug was that for the
purposes of
> checking joint limits the individually-labeled dofs were not being
mapped to
> the multi-dof joint.
>
> As arm_navigation matures we will try to do a better job of making
migration
> guides that explain new features and inform users what they need to do to
> adopt a new version. At this point we're focused on making relatively
large
> changes that we hope will make things work better and make it easier
to get
> our stacks working on other arms, but we still have a ways to go. We're
> targeting e-turtle for a 0.9 or 1.0, at which point things should
stabilize
> a good deal.
>
> Please let us know if the bug fix doesn't work or if you have other
> problems.
>
> -Gil
>
> --
> E. Gil Jones (gjones at willowgarage.com)
> Research Engineer
> Willow Garage, Inc.
> 68 Willow Road
> Menlo Park, CA 94025
> 650.475.9772 <tel:+16504759772>
>
>
> On Fri, Feb 4, 2011 at 1:23 AM, Sachin Chitta
<sachinc at willowgarage.com>wrote:
>
> > Hi Felix,
> >
> > This should be fixed in motion_planning_common 0.3.5 (thanks to Gil).
> > Can you try it out and let us know.
> >
> > Thanks,
> > Sachin
> >
> > On Wed, Feb 2, 2011 at 4:09 AM, "Felix Meßmer" <Felix_Messmer at web.de>
> > wrote:
> > > Dear community,
> > >
> > > there is another feature in the unstable/diamondback version of the
> > arm_navigation stack that I have problems with:
> > > the multi_dof_joints parameter-option!
> > >
> > > When I use our old launch file
> > (cob_arm_navigation/cob3_planning_environment.launch) that loads the
> > collision_checks and planning_groups paramters to the parameter
server, I
> > get the following error message from both the trajectory_filter and the
> > ompl_planning node:
> > >
> > > [ WARN] [1296646033.585385464]: No multi dof joints specified,
including
> > root to world conversion
> > > [ WARN] [1296646033.585623806]: Can't do anything without a root
> > transform
> > >
> > > I've adapted the planning_environment.launch file to also load the
> > multi_dof_joints parameter (looking at the according pr2-config files).
> > > But now planning reqest as in move_arm_simple_pose goal fail due
to the
> > following error message from the environment_server node and the
move_arm
> > action server node:
> > >
> > > [ WARN] [1296647088.916018038, 830.563000000]: No joint with name
> > floating_trans_x
> > > [ WARN] [1296647088.916446633, 830.563000000]: Joint limits violated.
> > >
> > > [ERROR] [1296647088.925356070, 830.563000000]: Will not plan to
requested
> > joint goal since it violates joint limits constraints
> > >
> > >
> > > The multi_dof_joints.yaml file I use looks like this:
> > >
> > >
> > >
> > >
> > >
> > > I guess the multi_dof_joint parameter is meant to introduce a
joint that
> > stands for the moving platform with 3 DoFs (trans_x, trans_y, rot_z)
> > > Does that mean that if the pose goal is specified in a world/global
> > coordinate system, the planner also considers and calculates a possibly
> > necessary platform motion to reach the specied goal?
> > >
> > > Is there a parameter (use_multidof?) for the environment_server to
> > deactivate multi_dof_joints?
> > > OR:
> > > What else do I have to add to use that feature?
> > >
> > >
> > > I hope you can give me a short explanation on that. Thanks a lot!
> > >
> > >
> > >
> > > Regards,
> > > Felix
> > > ___________________________________________________________
> > > WEB.DE DSL Doppel-Flat ab 19,99
More information about the ros-users
mailing list