Hi All,
I am wondering how you would implement a simulated force sensor to measure joint torques if the method physics::joint::GetForce(int) is not implemented. If anyone has done this with Gazebo any help would be appreciated.
cheers
Peter
John just committed a new (?) force torque sensor to the issue_16 branch: https://bitbucket.org/osrf/gazebo/commits/172726f2e6f1cb47e2fc0fbbc60ca61c70ab4b51
So there should be an official working solution in trunk soon.
It looks like that's a re-implementation of a feature that used to exist. It's necessary to create a force-torque sensor plugin as pointed to in my answer, but is not a force-torque sensor itself.
There is a ticket on bitbucket for creating an actual sensor: https://bitbucket.org/osrf/gazebo/issue/379/create-a-force-torque-sensor
DARPA arm simulator does that, as a gazebo plugin, here:
Note there was a specific gazebo tag in the URDF (<provideFeedback value="true"/>) that had to be used to get ODE to compute the force and torque at a particular point because it does some optimizations that typically prevent it from working.
I don't know if they've written a better implementation in the mean time, but this worked at the time.
Update: Note that from @ThomasK's response, the current version of Gazebo may not be able to use such a plugin until, the referenced patch is released.
Okay, thanks. It appears that the algorithm is a simplified Recursive Newton Euler Algorithm (google), basically only working with gravitational component (centrifugal and coriolis forces neglected (no big deal)), calculating the force backward from the tip of the end effector to the base. Correct?
Some of the code came from other places, and It's been a while so I don't exactly remember, but I'm sure I didn't specifically account for centrifugal and coriolis force unless it's already baked into GetBodyForce which it may be. I think that comes from ODE's calculations.
Okay, what then does GetBodyForce() output? Is it the cumulative force of child links on the COG of the current body, plus external (contact) forces? Your code suggests the cumulative force of the child links is calculated in calculatedForce loop (similar to RNEA) not using the GetBodyForce method
Hi, @asomerville, the files can't find anymore, can you post a new link?
Hi,
Have you tried creating a plugin, and then accessing the joint like this:
physics::JointPtr jointPtr;
jointPtr = this->myModel->GetJoint("jointName"); OR jointPtr = this->myModel->GetJoint(int index);
jointPtr->GetForce();
Here are some tutorials with plugins.
Cheers, Andrei
As Thomas mentioned, I've just begun implementing it in a brunch (e.g. see https://bitbucket.org/osrf/gazebo/src/172726f2e6f1cb47e2fc0fbbc60ca61c70ab4b51/gazebo/physics/Joint.cc?at=issue_16)
Sounds good, if you would like a working algorithm the Recursive Newton Euler Algorithm is an accepted algorithm for it and Roy Featherstone has made some nice tutorials on IEEE Explore. I've implemented it in my own non-gazebo sim, but I'm unsure how to make it work for a generic sdf. can send copy
Asked: 2012-12-03 17:33:25 -0500
Seen: 4,146 times
Last updated: Dec 04 '12
Copyright Askbot, 2010-2011. Content on this site is licensed under a Creative Commons Attribution Share Alike 3.0 license.
