Updated for viscous friction simulation
Updated URDF loader to handle transforms correctly