Rtos code cntains bug possible incompatability with I2C

Fork of mbed-rtos by mbed official

unknown revision 'f6e2ce20aa09'