xmega: Add Step Motor Capabilities in Xmega