How to write c code for xmega