Make pathfinding use A* and fix double removing of Path waypoints
Add enemy movement