It is nothing fancy, very basic. Here is a shot of me trying to debug things. Seems at a certain point it just doesn't see walls anymore. Must be something with stepping from block edge to block edge.