Adds URDF documentation.

Also fixes a few bugs related to the parameters and updates tests.