Merge pull request #4 from RoboGroup3/master

Accept merged version of code
Add visualization markers
Merged code from robot
Small change
Merge robot changes
Merge branch 'valeRB-master'
Merge pull request #17 from valeRB/master

Merge robot code