Create the lightweight version off an pathfinding and fix some bugs. Still many bugs .