Merge pull request #6 from JohanJohansson/master

Updates from Johan
Merge pull request #3 from RoboGroup3/master

Update from Johan
Merge pull request #7 from JohanJohansson/master

Adds build dependencies for messages
Added some new code
Fixes merge conflict
Merge branch 'valeRB-master'
Merge pull request #5 from RoboGroup3/master

Last commits from Robogroup