Added initialization and start-, stop and ack functions
Switched to I2C1 instead of I2C0 and added read/write functions
Fixed a few small mistakes, ready for testing if this little sets high and low some lines!