fix problem when joint in urdf has no pose defined, set pose at 0,0,0 - 0,0,0