Lagt till preliminär kod för skrivning till i2c-enhet
Merge branch 'master' of https://github.com/Grupp-5/robot