STMPE811: I2C reading routine

- Reading over I2C works.
- Some other cleanups.

Driver is not usable yet.