Improved efficiency of FIFO read

FIFO was read byte by byte, each with a separate wire.beginTransmission. Now a complete x,y,z triple (6 bytes) is read in one go.

I also removed one redundant function and did some "clean up".