Fix on crash if waypoint was twice in route.

Also added googlemaps module to lib folder since a few changes were
done.