SDF bugfixes to enable articulated bodies