Improved Communication

Communication over I2C works more reliably, but the arduino crashes