Fixed I2C issue in release mode (gcc optimization)
Fixed LED toggle code