Motors and voltage working i2c
LED and US working(1port)
GPS working
motor functions tested
Encoder targetting working(I2C crash)
Merge branch 'i2c_conversion'