Renamed "waist" to "torso", created torso_joint_b1 and torso_joint_b2.