Initial commit
Updated README
Add PolyTreeNode for pathfinding later