Merge pull request #63 from ipa-mig/navigation_maps

Update agv-testenv, add line and point map