Urdf parsing management

This pull request will enable the use of urdf parsing for romeo.