Added some functions in TWI c-file