[MSP430] I2C code refactoring part #2