PathFinding logic added

Code to add:
Visualise the path
Selecting a unit and its destination

Models required:
Some kind of obstruction (this could temp be represented by a different
colour block for now)