Börjat på lite funktioner för att skicka data samt gjort om och lagt konstanterna i header-filen istället
Merge branch 'master' of https://github.com/Grupp-5/robot