This fixes reading more than 2 bytes from the slave device. In the current implementation the last byte was not read from data register and the termination sequence buggy.