New waypoint adding function from john put into geomesa.utils