Remove debugging, especially from register.c as it was causing the i2c failure!