Added left/right joint names, added torso_joint_b1

and torso_joint_b2