Move code from Armar6Skills to ArmarXObjects