Fix #31: URDF loader crashes

The problem was caused by commit 10aa8f8c86dc2c4b6c212e2075348aa1a276f2a0. Revert a small part of it.