Merge pull request #7 from JohanJohansson/master

Updates from Johan
Merge pull request #8 from JohanJohansson/master

Updates from Johan
 Added the service to the mazefollower
Merge pull request #9 from Stinktier/master

 Added the service to the mazefollower
Merge pull request #2 from RoboGroup3/master

Updates from Marco