Added debugging stuff and switched output back to Serial
Some fixes to TWI access to hopefully make it work better