Should now work in both hydro and indigo

git-svn-id: https://roboticssrv.wtb.tue.nl/svn/ros/trunk/geolib2@26654 3a3c2cfb-d3b9-409e-9e75-db8fcdbcaac6