Create path finding routine

In the processes various 'modules' were added
'