Modified to be able to add waypoints to when creating maps
Merge pull request #26 from open-rdc/add-build-map-waypoints

Modified to be able to add waypoints to when creating maps