Reapplied changes from the master branch. Refactored the URDF loader. Compiles but not tested.
Merge branch 'refactoring' of github.com:dartsim/dart into refactoring