I have added a registry with unique IDs and a recursive function. The datapack now works with multiple waypoints wich was way to challenging but I think that it is really cool!