First pathfinder sort of implemented. There needs to be a step system for the A*.