added i2c and encoders

Have not tested i2c. Encoders seem to be working!