update cob4-1 torso and head positions