Milestone 2 Commit

MS2 code with working i2c