Added support for unit radius in FindPath (not implemented or tested yet)