Merge pull request #1 from RoboGroup3/master

Updates from the robot
Merge pull request #2 from RoboGroup3/master

Modified an integer division to double
Transformations work
Merge pull request #4 from JohanJohansson/master

Updates from Johan