Added support for SyMoRo+ Chain and Tree and fixed and prismatic joint