Add motor ID feature