Fixes several minor movement issues

-Fixes unit facing incorrectly
-Fixes unit choosing "weird" paths, basically ignoring diagonals