Moved twi_init into the m41t81s init function

It made no sense that we had to call this our selves.
Also removed unused defines used for debugging