Fixed bug on wrong assumption. Roel might have sensed more than one landmark in any given time step.
IssueID #8
Merge branch 'refs/heads/feature-4-GraphSLAMComment' into feature-3-EKF-Slam