Added simple A star pathing and modified safe diamond miner