Fixed bug on ReStart sending and get_byte on SDA master is down.
Removed debug and fixed timing.