cleaned up code ; added comments
Merge https://github.com/vlantaca/ATxmega128a4u-TWI