Start arm chains from torso instead of XShoulderPitchLink so that XShouldPitch is included in arm planning group

Start arm chains from torso so that XShoulderPitch is included in group