3D Grid-based path-finding | Unity3D