Issue19 floating joints

Addresses issue #19 and part of #3.  This PR depends upon ros/robot_model#87.

<EDIT>
PR is against `hydro-devel` (I need it in hydro), let me know if you want me to issue a PR against `indigo-devel` as well.
could this be a const &?