local changes
Merge branch 'master' of github.com:sauravag/FIRM-OMPL

Conflicts:
	SetupFiles/Setup4CornerWorld.xml
	main.cpp
	src/Planner/MMPolicyGenerator.cpp
Added a debug argument to kalman filter