Fixed initialization of 4 joints for torso, when they should be 3