Updated the Wiring Function

I2C Still needs work, but the wiring functions fixed.