It kinda works! Kinda. Many things need to be added / changed. Should really clean up the code as well.
Tweaking A* a bit. Still not great.