Update xmega_main.c