Update twi_sw_master.c