hondacrx
98 lines
2.9 KiB
C#
98 lines
2.9 KiB
C#
// Copyright (c) CypherCore <http://github.com/CypherCore> All rights reserved.
|
|
// Licensed under the GNU GENERAL PUBLIC LICENSE. See LICENSE file in the project root for full license information.
|
|
|
|
using Framework.GameMath;
|
|
using System.Collections.Generic;
|
|
using System.Numerics;
|
|
|
|
namespace Game.Collision
|
|
{
|
|
public class BIHWrap<T> where T : IModel
|
|
{
|
|
public void Insert(T obj)
|
|
{
|
|
++unbalanced_times;
|
|
m_objects_to_push.Add(obj);
|
|
}
|
|
public void Remove(T obj)
|
|
{
|
|
++unbalanced_times;
|
|
uint Idx;
|
|
if (m_obj2Idx.TryGetValue(obj, out Idx))
|
|
m_objects[(int)Idx] = null;
|
|
else
|
|
m_objects_to_push.Remove(obj);
|
|
}
|
|
|
|
public void Balance()
|
|
{
|
|
if (unbalanced_times == 0)
|
|
return;
|
|
|
|
unbalanced_times = 0;
|
|
m_objects.Clear();
|
|
m_objects.AddRange(m_obj2Idx.Keys);
|
|
m_objects.AddRange(m_objects_to_push);
|
|
|
|
m_tree.Build(m_objects);
|
|
}
|
|
|
|
public void IntersectRay(Ray ray, WorkerCallback intersectCallback, ref float maxDist)
|
|
{
|
|
Balance();
|
|
MDLCallback temp_cb = new(intersectCallback, m_objects.ToArray(), (uint)m_objects.Count);
|
|
m_tree.IntersectRay(ray, temp_cb, ref maxDist, true);
|
|
}
|
|
|
|
public void IntersectPoint(Vector3 point, WorkerCallback intersectCallback)
|
|
{
|
|
Balance();
|
|
MDLCallback callback = new(intersectCallback, m_objects.ToArray(), (uint)m_objects.Count);
|
|
m_tree.IntersectPoint(point, callback);
|
|
}
|
|
|
|
BIH m_tree = new();
|
|
List<T> m_objects = new();
|
|
Dictionary<T, uint> m_obj2Idx = new();
|
|
HashSet<T> m_objects_to_push = new();
|
|
int unbalanced_times;
|
|
|
|
public class MDLCallback : WorkerCallback
|
|
{
|
|
T[] objects;
|
|
WorkerCallback _callback;
|
|
uint objects_size;
|
|
|
|
public MDLCallback(WorkerCallback callback, T[] objects_array, uint size)
|
|
{
|
|
objects = objects_array;
|
|
_callback = callback;
|
|
objects_size = size;
|
|
}
|
|
|
|
/// Intersect ray
|
|
public override bool Invoke(Ray ray, uint idx, ref float maxDist, bool stopAtFirst)
|
|
{
|
|
if (idx >= objects_size)
|
|
return false;
|
|
|
|
T obj = objects[idx];
|
|
if (obj != null)
|
|
return _callback.Invoke(ray, obj, ref maxDist);
|
|
return false;
|
|
}
|
|
|
|
/// Intersect point
|
|
public override void Invoke(Vector3 p, uint idx)
|
|
{
|
|
if (idx >= objects_size)
|
|
return;
|
|
|
|
T obj = objects[idx];
|
|
if (obj != null)
|
|
_callback.Invoke(p, obj as GameObjectModel);
|
|
}
|
|
}
|
|
}
|
|
}
|