Multiple bugfixes to handling articulated bodies