TWI Watchdog and startup bugfix