2DRustPathfinder

I tried to make it as speed efficient as possible OK?

This is rust code so dont judge me im still learning :/