-Improved file/package structure and naming.

-Created SwarmPathFinding, should be full functional