AStar improvement

The AStar path finder can also make diagonal paths now.