Graphics 800,600,16,2
SetBuffer BackBuffer()
SeedRnd MilliSecs()
AppTitle "Waypoint"

n = 10

Dim WayPointX(n)
Dim WayPointY(n)

For i = 1 To n
 WayPointX(i) = Rnd(800)
 WayPointY(i) = Rnd(600)
Next

Global PosX# = 400
Global PosY# = 300
Speed = 10
Global WP
Winkel = NextWayPoint()

Repeat
Cls

Text 0,0, winkel

For i = 1 To n
 Color 100,0,0: Oval WayPointX(i)-5, WayPointY(i)-5, 10, 10
 Color 255,255,255: Text WayPointX(i), WayPointY(i), i
 If i < WP Then Color 200,200,0: Oval WayPointX(i)-5, WayPointY(i)-5, 10, 10
Next

Color 0,0,150: Oval PosX-5, PosY-5, 10, 10

Color 0,100,0: Oval WayPointX(WP)-5, WayPointY(WP)-5, 10, 10


PosX = PosX + Cos(Winkel) * speed
PosY = PosY + Sin(Winkel) * speed

If Abs(WayPointX(WP) - PosX) =< Speed And Abs(WayPointY(WP) - PosY) =< Speed Then Winkel = NextWayPoint()

Flip
Until KeyHit(1)
End

Function NextWayPoint()
 WP = WP + 1
 If WP = 11 Then WP = 1
 Winkel# = (450 - ATan2((WayPointX(WP) - PosX), (WayPointY(WP) - PosY))) Mod 360
 Return Winkel#
End Function