Path finding solution started

All movement based solutions seems to suck
Clean up
Neighbor mapping
Path finding v0