Add desired joint angles to scope of torso joint pos-vel