Cleanup and add TWI write function
TWILIB: permit the read of sequential registers
TWILIB: Allow multiple length writes