2023-03-14 08:02:43 +03:00
|
|
|
/*
|
|
|
|
Copyright (c) 2009-2010 Mikko Mononen memon@inside.org
|
|
|
|
recast4j copyright (c) 2015-2019 Piotr Piastucki piotr@jtilia.org
|
2023-03-15 17:00:29 +03:00
|
|
|
DotRecast Copyright (c) 2023 Choi Ikpil ikpil@naver.com
|
2023-03-14 08:02:43 +03:00
|
|
|
|
|
|
|
This software is provided 'as-is', without any express or implied
|
|
|
|
warranty. In no event will the authors be held liable for any damages
|
|
|
|
arising from the use of this software.
|
|
|
|
Permission is granted to anyone to use this software for any purpose,
|
|
|
|
including commercial applications, and to alter it and redistribute it
|
|
|
|
freely, subject to the following restrictions:
|
|
|
|
1. The origin of this software must not be misrepresented; you must not
|
|
|
|
claim that you wrote the original software. If you use this software
|
|
|
|
in a product, an acknowledgment in the product documentation would be
|
|
|
|
appreciated but is not required.
|
|
|
|
2. Altered source versions must be plainly marked as such, and must not be
|
|
|
|
misrepresented as being the original software.
|
|
|
|
3. This notice may not be removed or altered from any source distribution.
|
|
|
|
*/
|
|
|
|
|
|
|
|
using System;
|
|
|
|
using System.Collections.Generic;
|
|
|
|
using System.Linq;
|
|
|
|
|
2023-03-16 19:09:10 +03:00
|
|
|
namespace DotRecast.Detour.Crowd
|
|
|
|
{
|
2023-03-16 19:48:49 +03:00
|
|
|
public class ProximityGrid
|
|
|
|
{
|
2023-05-03 18:29:08 +03:00
|
|
|
private readonly float _cellSize;
|
|
|
|
private readonly float _invCellSize;
|
|
|
|
private readonly Dictionary<long, List<CrowdAgent>> _items;
|
2023-03-16 19:48:49 +03:00
|
|
|
|
2023-05-03 18:29:08 +03:00
|
|
|
public ProximityGrid(float cellSize)
|
2023-03-16 19:48:49 +03:00
|
|
|
{
|
2023-05-03 18:29:08 +03:00
|
|
|
_cellSize = cellSize;
|
|
|
|
_invCellSize = 1.0f / cellSize;
|
|
|
|
_items = new Dictionary<long, List<CrowdAgent>>();
|
2023-03-16 19:48:49 +03:00
|
|
|
}
|
2023-03-16 19:09:10 +03:00
|
|
|
|
2023-05-03 18:29:08 +03:00
|
|
|
public static long CombineKey(int x, int y)
|
2023-03-16 19:48:49 +03:00
|
|
|
{
|
2023-05-03 18:29:08 +03:00
|
|
|
uint ux = (uint)x;
|
|
|
|
uint uy = (uint)y;
|
|
|
|
return ((long)ux << 32) | uy;
|
2023-03-16 19:48:49 +03:00
|
|
|
}
|
2023-03-14 08:02:43 +03:00
|
|
|
|
2023-05-03 18:29:08 +03:00
|
|
|
public static void DecomposeKey(long key, out int x, out int y)
|
2023-03-16 19:48:49 +03:00
|
|
|
{
|
2023-05-03 18:29:08 +03:00
|
|
|
uint ux = (uint)(key >> 32);
|
|
|
|
uint uy = (uint)key;
|
|
|
|
x = (int)ux;
|
|
|
|
y = (int)uy;
|
|
|
|
}
|
|
|
|
|
|
|
|
void Clear()
|
|
|
|
{
|
|
|
|
_items.Clear();
|
|
|
|
}
|
|
|
|
|
|
|
|
public void AddItem(CrowdAgent agent, float minx, float miny, float maxx, float maxy)
|
|
|
|
{
|
|
|
|
int iminx = (int)Math.Floor(minx * _invCellSize);
|
|
|
|
int iminy = (int)Math.Floor(miny * _invCellSize);
|
|
|
|
int imaxx = (int)Math.Floor(maxx * _invCellSize);
|
|
|
|
int imaxy = (int)Math.Floor(maxy * _invCellSize);
|
2023-03-16 19:48:49 +03:00
|
|
|
|
|
|
|
for (int y = iminy; y <= imaxy; ++y)
|
|
|
|
{
|
|
|
|
for (int x = iminx; x <= imaxx; ++x)
|
|
|
|
{
|
2023-05-03 18:29:08 +03:00
|
|
|
long key = CombineKey(x, y);
|
|
|
|
if (!_items.TryGetValue(key, out var ids))
|
2023-03-16 19:48:49 +03:00
|
|
|
{
|
|
|
|
ids = new List<CrowdAgent>();
|
2023-05-03 18:29:08 +03:00
|
|
|
_items.Add(key, ids);
|
2023-03-16 19:48:49 +03:00
|
|
|
}
|
|
|
|
|
|
|
|
ids.Add(agent);
|
2023-03-14 08:02:43 +03:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2023-05-03 18:29:08 +03:00
|
|
|
public HashSet<CrowdAgent> QueryItems(float minx, float miny, float maxx, float maxy)
|
2023-03-16 19:48:49 +03:00
|
|
|
{
|
2023-05-03 18:29:08 +03:00
|
|
|
int iminx = (int)Math.Floor(minx * _invCellSize);
|
|
|
|
int iminy = (int)Math.Floor(miny * _invCellSize);
|
|
|
|
int imaxx = (int)Math.Floor(maxx * _invCellSize);
|
|
|
|
int imaxy = (int)Math.Floor(maxy * _invCellSize);
|
2023-03-16 19:48:49 +03:00
|
|
|
|
|
|
|
HashSet<CrowdAgent> result = new HashSet<CrowdAgent>();
|
|
|
|
for (int y = iminy; y <= imaxy; ++y)
|
|
|
|
{
|
|
|
|
for (int x = iminx; x <= imaxx; ++x)
|
|
|
|
{
|
2023-05-03 18:29:08 +03:00
|
|
|
long key = CombineKey(x, y);
|
|
|
|
if (_items.TryGetValue(key, out var ids))
|
2023-03-16 19:48:49 +03:00
|
|
|
{
|
2023-05-11 18:04:14 +03:00
|
|
|
for (int i = 0; i < ids.Count; ++i)
|
|
|
|
{
|
|
|
|
result.Add(ids[i]);
|
|
|
|
}
|
2023-03-16 19:48:49 +03:00
|
|
|
}
|
2023-03-14 08:02:43 +03:00
|
|
|
}
|
|
|
|
}
|
2023-03-16 19:48:49 +03:00
|
|
|
|
|
|
|
return result;
|
2023-03-14 08:02:43 +03:00
|
|
|
}
|
|
|
|
|
2023-05-03 18:29:08 +03:00
|
|
|
public IEnumerable<(long, int)> GetItemCounts()
|
2023-03-16 19:48:49 +03:00
|
|
|
{
|
2023-05-03 18:29:08 +03:00
|
|
|
return _items
|
2023-03-16 19:48:49 +03:00
|
|
|
.Where(e => e.Value.Count > 0)
|
2023-05-03 18:29:08 +03:00
|
|
|
.Select(e => (e.Key, e.Value.Count));
|
2023-03-16 19:48:49 +03:00
|
|
|
}
|
2023-03-14 08:02:43 +03:00
|
|
|
|
2023-05-03 18:29:08 +03:00
|
|
|
public float GetCellSize()
|
2023-03-16 19:48:49 +03:00
|
|
|
{
|
2023-05-03 18:29:08 +03:00
|
|
|
return _cellSize;
|
2023-03-16 19:48:49 +03:00
|
|
|
}
|
|
|
|
}
|
2023-03-16 19:09:10 +03:00
|
|
|
}
|