Add speed, position and torque reference parsing