https://alufr-ros-pkg.googlecode.com/svn/trunk/articulation/demo_fitting:55
