add comments, add output for failure case, remove debug code and opengl display.
set the database to Heerlen testsite.
Merge pull request #13 from uh-klk/master

Latest update from Context Aware Planner