Merge pull request #2 from ZdenekM/groovy_dev

Added dependency to map_msgs.
Merge branch 'groovy_dev' of https://github.com/DLu/navigation into groovy_dev
Debug output added and fixed formatting.