Roel's equations fixed mostly
issueId #11
Merge branch 'origin/feature-11-EKF-SLAM-report'

Conflicts:
	Article parts/Gabi/SLAM_PAPER.log

MErging branch. issueID #11