Implemented basic pathfinding waypoint-to-waypoint, but there are some
anomalies involved with Offset coordinates.