added waypoint updating