First sketch

This uses the i2c lcd and the 9dof