Update Astar Implementation

Includes fixed follower/mover test functionality
Simplified pretty much everything