[waypoint] fix vertical moves when FreeZ