Hi,
I'd be more than happy to write you a quick pathfinding algorithm, or spend time on a more complex one if necessary.
I've had several years of experience in Python, as well as taking part in programming competitions for algorithm design.
Please do get in touch with your requirements.