fully working program

I2C address corrected and proper init created