added waypoint saving. saving should be fine.....