A Path Finder

In this update I added some things: now you can also search for a path, using waypoints. You can set the program to find the best way between these waypoints, or you can set it to follow the waypoints in a given order. The code isn't very fast if you use the waypointmethod ... Hope you can use it. I'd appreciate it if you give me any comments or tell me some bugs. Thanx