Fix URDF loader. Works with refactored DART now.