b2DynamicTree.h
Go to the documentation of this file.
1 /*
2 * Copyright (c) 2009 Erin Catto http://www.box2d.org
3 *
4 * This software is provided 'as-is', without any express or implied
5 * warranty. In no event will the authors be held liable for any damages
6 * arising from the use of this software.
7 * Permission is granted to anyone to use this software for any purpose,
8 * including commercial applications, and to alter it and redistribute it
9 * freely, subject to the following restrictions:
10 * 1. The origin of this software must not be misrepresented; you must not
11 * claim that you wrote the original software. If you use this software
12 * in a product, an acknowledgment in the product documentation would be
13 * appreciated but is not required.
14 * 2. Altered source versions must be plainly marked as such, and must not be
15 * misrepresented as being the original software.
16 * 3. This notice may not be removed or altered from any source distribution.
17 */
18 
19 #ifndef B2_DYNAMIC_TREE_H
20 #define B2_DYNAMIC_TREE_H
21 
24 
25 #define b2_nullNode (-1)
26 
28 struct b2TreeNode
29 {
30  bool IsLeaf() const
31  {
32  return child1 == b2_nullNode;
33  }
34 
37 
38  void* userData;
39 
40  union
41  {
44  };
45 
48 
49  // leaf = 0, free node = -1
51 };
52 
62 {
63 public:
65  b2DynamicTree();
66 
68  ~b2DynamicTree();
69 
71  int32 CreateProxy(const b2AABB& aabb, void* userData);
72 
74  void DestroyProxy(int32 proxyId);
75 
80  bool MoveProxy(int32 proxyId, const b2AABB& aabb1, const b2Vec2& displacement);
81 
84  void* GetUserData(int32 proxyId) const;
85 
87  const b2AABB& GetFatAABB(int32 proxyId) const;
88 
91  template <typename T>
92  void Query(T* callback, const b2AABB& aabb) const;
93 
101  template <typename T>
102  void RayCast(T* callback, const b2RayCastInput& input) const;
103 
105  void Validate() const;
106 
109  int32 GetHeight() const;
110 
113  int32 GetMaxBalance() const;
114 
116  float32 GetAreaRatio() const;
117 
119  void RebuildBottomUp();
120 
124  void ShiftOrigin(const b2Vec2& newOrigin);
125 
126 private:
127 
128  int32 AllocateNode();
129  void FreeNode(int32 node);
130 
131  void InsertLeaf(int32 node);
132  void RemoveLeaf(int32 node);
133 
134  int32 Balance(int32 index);
135 
136  int32 ComputeHeight() const;
137  int32 ComputeHeight(int32 nodeId) const;
138 
139  void ValidateStructure(int32 index) const;
140  void ValidateMetrics(int32 index) const;
141 
143 
147 
149 
152 
154 };
155 
156 inline void* b2DynamicTree::GetUserData(int32 proxyId) const
157 {
158  b2Assert(0 <= proxyId && proxyId < m_nodeCapacity);
159  return m_nodes[proxyId].userData;
160 }
161 
162 inline const b2AABB& b2DynamicTree::GetFatAABB(int32 proxyId) const
163 {
164  b2Assert(0 <= proxyId && proxyId < m_nodeCapacity);
165  return m_nodes[proxyId].aabb;
166 }
167 
168 template <typename T>
169 inline void b2DynamicTree::Query(T* callback, const b2AABB& aabb) const
170 {
172  stack.Push(m_root);
173 
174  while (stack.GetCount() > 0)
175  {
176  int32 nodeId = stack.Pop();
177  if (nodeId == b2_nullNode)
178  {
179  continue;
180  }
181 
182  const b2TreeNode* node = m_nodes + nodeId;
183 
184  if (b2TestOverlap(node->aabb, aabb))
185  {
186  if (node->IsLeaf())
187  {
188  bool proceed = callback->QueryCallback(nodeId);
189  if (proceed == false)
190  {
191  return;
192  }
193  }
194  else
195  {
196  stack.Push(node->child1);
197  stack.Push(node->child2);
198  }
199  }
200  }
201 }
202 
203 template <typename T>
204 inline void b2DynamicTree::RayCast(T* callback, const b2RayCastInput& input) const
205 {
206  b2Vec2 p1 = input.p1;
207  b2Vec2 p2 = input.p2;
208  b2Vec2 r = p2 - p1;
209  b2Assert(r.LengthSquared() > 0.0f);
210  r.Normalize();
211 
212  // v is perpendicular to the segment.
213  b2Vec2 v = b2Cross(1.0f, r);
214  b2Vec2 abs_v = b2Abs(v);
215 
216  // Separating axis for segment (Gino, p80).
217  // |dot(v, p1 - c)| > dot(|v|, h)
218 
219  float32 maxFraction = input.maxFraction;
220 
221  // Build a bounding box for the segment.
222  b2AABB segmentAABB;
223  {
224  b2Vec2 t = p1 + maxFraction * (p2 - p1);
225  segmentAABB.lowerBound = b2Min(p1, t);
226  segmentAABB.upperBound = b2Max(p1, t);
227  }
228 
230  stack.Push(m_root);
231 
232  while (stack.GetCount() > 0)
233  {
234  int32 nodeId = stack.Pop();
235  if (nodeId == b2_nullNode)
236  {
237  continue;
238  }
239 
240  const b2TreeNode* node = m_nodes + nodeId;
241 
242  if (b2TestOverlap(node->aabb, segmentAABB) == false)
243  {
244  continue;
245  }
246 
247  // Separating axis for segment (Gino, p80).
248  // |dot(v, p1 - c)| > dot(|v|, h)
249  b2Vec2 c = node->aabb.GetCenter();
250  b2Vec2 h = node->aabb.GetExtents();
251  float32 separation = b2Abs(b2Dot(v, p1 - c)) - b2Dot(abs_v, h);
252  if (separation > 0.0f)
253  {
254  continue;
255  }
256 
257  if (node->IsLeaf())
258  {
259  b2RayCastInput subInput;
260  subInput.p1 = input.p1;
261  subInput.p2 = input.p2;
262  subInput.maxFraction = maxFraction;
263 
264  float32 value = callback->RayCastCallback(subInput, nodeId);
265 
266  if (value == 0.0f)
267  {
268  // The client has terminated the ray cast.
269  return;
270  }
271 
272  if (value > 0.0f)
273  {
274  // Update segment bounding box.
275  maxFraction = value;
276  b2Vec2 t = p1 + maxFraction * (p2 - p1);
277  segmentAABB.lowerBound = b2Min(p1, t);
278  segmentAABB.upperBound = b2Max(p1, t);
279  }
280  }
281  else
282  {
283  stack.Push(node->child1);
284  stack.Push(node->child2);
285  }
286  }
287 }
288 
289 #endif
#define b2_nullNode
Definition: b2DynamicTree.h:25
const b2AABB & GetFatAABB(int32 proxyId) const
Get the fat AABB for a proxy.
float32 b2Dot(const b2Vec2 &a, const b2Vec2 &b)
Perform the dot product on two vectors.
Definition: b2Math.h:406
int32 child2
Definition: b2DynamicTree.h:47
b2Vec2 GetCenter() const
Get the center of the AABB.
Definition: b2Collision.h:168
b2Vec2 lowerBound
the lower vertex
Definition: b2Collision.h:214
f
int32 m_nodeCapacity
b2AABB aabb
Enlarged AABB.
Definition: b2DynamicTree.h:36
Ray-cast input data. The ray extends from p1 to p1 + maxFraction * (p2 - p1).
Definition: b2Collision.h:147
float32 LengthSquared() const
Definition: b2Math.h:108
int32 child1
Definition: b2DynamicTree.h:46
int32 height
Definition: b2DynamicTree.h:50
T b2Max(T a, T b)
Definition: b2Math.h:643
A 2D column vector.
Definition: b2Math.h:53
b2TreeNode * m_nodes
b2Vec2 GetExtents() const
Get the extents of the AABB (half-widths).
Definition: b2Collision.h:174
signed int int32
Definition: b2Settings.h:31
float32 b2Cross(const b2Vec2 &a, const b2Vec2 &b)
Perform the cross product on two vectors. In 2D this produces a scalar.
Definition: b2Math.h:412
int32 parent
Definition: b2DynamicTree.h:42
uint32 m_path
This is used to incrementally traverse the tree for re-balancing.
int32 m_insertionCount
unsigned int uint32
Definition: b2Settings.h:34
float32 maxFraction
Definition: b2Collision.h:150
void Push(const T &element)
bool IsLeaf() const
Definition: b2DynamicTree.h:30
void * userData
Definition: b2DynamicTree.h:38
void Query(T *callback, const b2AABB &aabb) const
A node in the dynamic tree. The client does not interact with this directly.
Definition: b2DynamicTree.h:28
An axis aligned bounding box.
Definition: b2Collision.h:162
#define b2Assert(A)
Definition: b2Settings.h:27
T b2Abs(T a)
Definition: b2Math.h:616
T b2Min(T a, T b)
Definition: b2Math.h:632
void * GetUserData(int32 proxyId) const
float32 Normalize()
Convert this vector into a unit vector. Returns the length.
Definition: b2Math.h:114
bool b2TestOverlap(const b2Shape *shapeA, int32 indexA, const b2Shape *shapeB, int32 indexB, const b2Transform &xfA, const b2Transform &xfB)
Determine if two generic shapes overlap.
float float32
Definition: b2Settings.h:35
void RayCast(T *callback, const b2RayCastInput &input) const
b2Vec2 upperBound
the upper vertex
Definition: b2Collision.h:215


mvsim
Author(s):
autogenerated on Thu Jun 6 2019 19:36:40