void move_next()
 {
     CFG.Anchor        = NextNode.ToWayPoint();
     CFG.Anchor.Radius = C.NodeTargetRange;
     SetTarget(CFG.Anchor);
     stage = Stage.MoveNext;
 }