handle massless components in URDF models

[baggepinnen]

bodies with zero mass results in singular systems, we thus add components without dynamics for visualizaiton purposes