Xmega code fix
Merge branch 'master' of https://github.com/fromeijn/Robotica

Conflicts:
	Xmega_NXT/Xmega_NXT/Main.c