Global waypoint.waypoint
Type waypoint
  Field entity
  Field name$
  Field sphere
End Type

Function findpath(npc.test,endwaypoint$)
    numberofarray = 0
   npc\currentnode = 0
   npcnode = 0
   nexit = 0

   
   npc\targetnode$ = endwaypoint$

    For waypoint.waypoint = Each waypoint
     If waypoint\name$ = endwaypoint$ Then endwaypoinentity = waypoint\entity
    Next

   nextnode = CreatePivot()
   PositionEntity nextnode,EntityX(npc\mesh),EntityY(npc\mesh),EntityZ(npc\mesh)
    .try
   numberofarray = 0
   sortclose(nextnode,npc.test)
   For i = 0 To numberofarray
     For waypoint.waypoint = Each waypoint
      If waypoint\name$ = close(i)
       waypointentity = waypoint\entity
       waypointname$ = waypoint\name
       If numberofarray > 1
        For inp = 0 To numberofarray - 1
           If EntityDistance(closeentity(inp),endwaypoinentity) <= EntityDistance(waypointentity,endwaypoinentity) Then waypointentity = closeentity(inp):npc\way[npc\currentnode] = close(inp):npc\currentnode = npc\currentnode + 1:nextnodename = close(inp):nextnode = closeentity(inp)   
       Next
       Else If numberofarray = 1
       If EntityDistance(closeentity(0),endwaypoinentity) <= EntityDistance(waypointentity,endwaypoinentity) Then npc\way[npc\currentnode] = close(0):npc\currentnode = npc\currentnode + 1:nextnodename = close(0):nextnode = closeentity(0) 
        End If
       End If
    Next
   Next

   If nextnodename <> endwaypoint Then Goto try Else npc\currentnode = 0:Return
End Function

Function sortclose(entity,npc.test)
For waypoint.waypoint = Each waypoint
 haveanode = 0
 For ion = 0 To 200
 If waypoint\name$ = npc\way[ion] Then haveanode = 1
 Next
 If EntityDistance(entity,waypoint\entity) <= 16 And waypoint\name <> nextnodename
  If haveanode = 0 Then close(numberofarray) = waypoint\name:closeentity(numberofarray) = waypoint\entity:numberofarray = numberofarray + 1
      Cls
  End If 
Next
End Function

       Else If numberofarray = 1
       If EntityDistance(closeentity(0),endwaypoinentity) <= EntityDistance(waypointentity,endwaypoinentity) Then npc\way[npc\currentnode] = close(0):npc\currentnode = npc\currentnode + 1:nextnodename = close(0):nextnode = closeentity(0) 
        End If
       End If
    Next
   Next
   Text 0,500,nextnodename
   For ko = 0 To 150
    Text ko*10,ko*10,npc\way[ko]:Flip
   Next
   If nextnodename <> endwaypoint Then Goto try Else npc\currentnode = 0:Return

   Text 0,500,nextnodename
   For ko = 0 To 150
    Text ko*10,ko*10,npc\way[ko]:Flip
   Next

If nextnodename <> endwaypoint Then Goto try Else npc\currentnode = 0:Return