Merge pull request #3 from RoboGroup3/master

Updates from Valeria
Merge pull request #4 from RoboGroup3/master

Updates from robot
Corrects the orientation for pose marker
Merge pull request #6 from JohanJohansson/master

Updates from Johan