STMPE811: reading registers over I2C

- Reading works.
- Some other cleanups.

Driver is not usable yet.