Initialize initial configuration even if root joint is not free-flyer.
Add functions to load an urdf/srdf model using ros parameters.