Made working code for I2C, Encoders, and Motors, to a certain extent.
Passing floats to functions is currently not working...