KiCad PCB EDA Suite
shape_collisions.cpp File Reference
#include <cmath>
#include <limits.h>
#include <geometry/seg.h>
#include <geometry/shape.h>
#include <geometry/shape_arc.h>
#include <geometry/shape_line_chain.h>
#include <geometry/shape_circle.h>
#include <geometry/shape_rect.h>
#include <geometry/shape_segment.h>
#include <geometry/shape_compound.h>
#include <math/vector2d.h>

Go to the source code of this file.

Typedefs

typedef VECTOR2I::extended_type ecoord
 

Functions

static bool Collide (const SHAPE_CIRCLE &aA, const SHAPE_CIRCLE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_RECT &aA, const SHAPE_CIRCLE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static VECTOR2I pushoutForce (const SHAPE_CIRCLE &aA, const SEG &aB, int aClearance)
 
static bool Collide (const SHAPE_CIRCLE &aA, const SHAPE_LINE_CHAIN_BASE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_CIRCLE &aA, const SHAPE_SEGMENT &aSeg, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_LINE_CHAIN_BASE &aA, const SHAPE_LINE_CHAIN_BASE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_RECT &aA, const SHAPE_LINE_CHAIN_BASE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_RECT &aA, const SHAPE_SEGMENT &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_SEGMENT &aA, const SHAPE_SEGMENT &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_LINE_CHAIN_BASE &aA, const SHAPE_SEGMENT &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_RECT &aA, const SHAPE_RECT &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_ARC &aA, const SHAPE_RECT &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_ARC &aA, const SHAPE_CIRCLE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_ARC &aA, const SHAPE_LINE_CHAIN &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_ARC &aA, const SHAPE_SEGMENT &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_ARC &aA, const SHAPE_LINE_CHAIN_BASE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool Collide (const SHAPE_ARC &aA, const SHAPE_ARC &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
template<class T_a , class T_b >
bool CollCase (const SHAPE *aA, const SHAPE *aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
template<class T_a , class T_b >
bool CollCaseReversed (const SHAPE *aA, const SHAPE *aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool collideSingleShapes (const SHAPE *aA, const SHAPE *aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 
static bool collideShapes (const SHAPE *aA, const SHAPE *aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
 

Typedef Documentation

◆ ecoord

Definition at line 39 of file shape_collisions.cpp.

Function Documentation

◆ CollCase()

template<class T_a , class T_b >
bool CollCase ( const SHAPE aA,
const SHAPE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inline

Definition at line 676 of file shape_collisions.cpp.

679 {
680  return Collide( *static_cast<const T_a*>( aA ), *static_cast<const T_b*>( aB ),
681  aClearance, aActual, aLocation, aMTV);
682 }
static bool Collide(const SHAPE_CIRCLE &aA, const SHAPE_CIRCLE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)

References Collide().

◆ CollCaseReversed()

template<class T_a , class T_b >
bool CollCaseReversed ( const SHAPE aA,
const SHAPE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inline

Definition at line 686 of file shape_collisions.cpp.

688 {
689  bool rv = Collide( *static_cast<const T_b*>( aB ), *static_cast<const T_a*>( aA ),
690  aClearance, aActual, aLocation, aMTV);
691 
692  if( rv && aMTV)
693  *aMTV = - *aMTV;
694 
695  return rv;
696 }
static bool Collide(const SHAPE_CIRCLE &aA, const SHAPE_CIRCLE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)

References Collide().

◆ Collide() [1/16]

static bool Collide ( const SHAPE_CIRCLE aA,
const SHAPE_CIRCLE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 42 of file shape_collisions.cpp.

44 {
45  ecoord min_dist = aClearance + aA.GetRadius() + aB.GetRadius();
46  ecoord min_dist_sq = min_dist * min_dist;
47 
48  const VECTOR2I delta = aB.GetCenter() - aA.GetCenter();
49  ecoord dist_sq = delta.SquaredEuclideanNorm();
50 
51  if( dist_sq == 0 || dist_sq < min_dist_sq )
52  {
53  if( aActual )
54  *aActual = std::max( 0, (int) sqrt( dist_sq ) - aA.GetRadius() - aB.GetRadius() );
55 
56  if( aLocation )
57  *aLocation = ( aA.GetCenter() + aB.GetCenter() ) / 2;
58 
59  if( aMTV )
60  *aMTV = delta.Resize( min_dist - sqrt( dist_sq ) + 3 ); // fixme: apparent rounding error
61 
62  return true;
63  }
64 
65  return false;
66 }
int GetRadius() const
Definition: shape_circle.h:107
Define a general 2D-vector/point.
Definition: vector2d.h:61
const VECTOR2I GetCenter() const
Definition: shape_circle.h:112
VECTOR2I::extended_type ecoord
constexpr int delta

References delta, SHAPE_CIRCLE::GetCenter(), and SHAPE_CIRCLE::GetRadius().

Referenced by BOOST_AUTO_TEST_CASE(), CollCase(), CollCaseReversed(), and Collide().

◆ Collide() [2/16]

static bool Collide ( const SHAPE_RECT aA,
const SHAPE_CIRCLE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 69 of file shape_collisions.cpp.

71 {
72  const VECTOR2I c = aB.GetCenter();
73  const VECTOR2I p0 = aA.GetPosition();
74  const VECTOR2I size = aA.GetSize();
75  const int r = aB.GetRadius();
76  const int min_dist = aClearance + r;
77  const ecoord min_dist_sq = SEG::Square( min_dist );
78 
79  const VECTOR2I vts[] =
80  {
81  VECTOR2I( p0.x, p0.y ),
82  VECTOR2I( p0.x, p0.y + size.y ),
83  VECTOR2I( p0.x + size.x, p0.y + size.y ),
84  VECTOR2I( p0.x + size.x, p0.y ),
85  VECTOR2I( p0.x, p0.y )
86  };
87 
88  ecoord nearest_side_dist_sq = VECTOR2I::ECOORD_MAX;
89  VECTOR2I nearest;
90 
91  bool inside = c.x >= p0.x && c.x <= ( p0.x + size.x )
92  && c.y >= p0.y && c.y <= ( p0.y + size.y );
93 
94  // If we're not looking for MTV or actual, short-circuit once we find a hard collision
95  if( inside && !aActual && !aLocation && !aMTV )
96  return true;
97 
98  for( int i = 0; i < 4; i++ )
99  {
100  const SEG side( vts[i], vts[ i + 1] );
101 
102  VECTOR2I pn = side.NearestPoint( c );
103  ecoord side_dist_sq = ( pn - c ).SquaredEuclideanNorm();
104 
105  if( side_dist_sq < nearest_side_dist_sq )
106  {
107  nearest = pn;
108  nearest_side_dist_sq = side_dist_sq;
109 
110  if( aMTV )
111  continue;
112 
113  if( nearest_side_dist_sq == 0 )
114  break;
115 
116  // If we're not looking for aActual then any collision will do
117  if( nearest_side_dist_sq < min_dist_sq && !aActual )
118  break;
119  }
120  }
121 
122  if( inside || nearest_side_dist_sq == 0 || nearest_side_dist_sq < min_dist_sq )
123  {
124  if( aLocation )
125  *aLocation = nearest;
126 
127  if( aActual )
128  *aActual = std::max( 0, (int) sqrt( nearest_side_dist_sq ) - r );
129 
130  if( aMTV )
131  {
132  VECTOR2I delta = c - nearest;
133 
134  if( inside )
135  *aMTV = -delta.Resize( abs( min_dist + 1 + sqrt( nearest_side_dist_sq ) ) + 1 );
136  else
137  *aMTV = delta.Resize( abs( min_dist + 1 - sqrt( nearest_side_dist_sq ) ) + 1 );
138  }
139 
140  return true;
141  }
142 
143  return false;
144 }
int GetRadius() const
Definition: shape_circle.h:107
Define a general 2D-vector/point.
Definition: vector2d.h:61
const VECTOR2I GetCenter() const
Definition: shape_circle.h:112
VECTOR2< int > VECTOR2I
Definition: vector2d.h:623
static SEG::ecoord Square(int a)
Definition: seg.h:122
const VECTOR2I GetSize() const
Definition: shape_rect.h:124
static constexpr extended_type ECOORD_MAX
Definition: vector2d.h:79
const VECTOR2I & GetPosition() const
Definition: shape_rect.h:116
VECTOR2I::extended_type ecoord
E_SERIE r
Definition: eserie.cpp:41
Definition: seg.h:40
constexpr int delta

References delta, VECTOR2< T >::ECOORD_MAX, SHAPE_CIRCLE::GetCenter(), SHAPE_RECT::GetPosition(), SHAPE_CIRCLE::GetRadius(), SHAPE_RECT::GetSize(), SEG::NearestPoint(), r, SEG::Square(), VECTOR2< T >::x, and VECTOR2< T >::y.

◆ Collide() [3/16]

static bool Collide ( const SHAPE_CIRCLE aA,
const SHAPE_LINE_CHAIN_BASE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 174 of file shape_collisions.cpp.

176 {
177  int closest_dist = INT_MAX;
178  int closest_mtv_dist = INT_MAX;
179  VECTOR2I nearest;
180  int closest_mtv_seg = -1;
181 
182  if( aB.IsClosed() && aB.PointInside( aA.GetCenter() ) )
183  {
184  nearest = aA.GetCenter();
185  closest_dist = 0;
186 
187  if( aMTV )
188  {
189  for( int s = 0; s < aB.GetSegmentCount(); s++ )
190  {
191  int dist = aB.GetSegment(s).Distance( aA.GetCenter() );
192 
193  if( dist < closest_mtv_dist )
194  {
195  closest_mtv_dist = dist;
196  closest_mtv_seg = s;
197  }
198  }
199  }
200 
201  }
202  else
203  {
204  for( size_t s = 0; s < aB.GetSegmentCount(); s++ )
205  {
206  int collision_dist = 0;
207  VECTOR2I pn;
208 
209  if( aA.Collide( aB.GetSegment( s ), aClearance,
210  aActual || aLocation ? &collision_dist : nullptr,
211  aLocation ? &pn : nullptr ) )
212  {
213  if( collision_dist < closest_dist )
214  {
215  nearest = pn;
216  closest_dist = collision_dist;
217  }
218 
219  if( closest_dist == 0 )
220  break;
221 
222  // If we're not looking for aActual then any collision will do
223  if( !aActual )
224  break;
225  }
226  }
227  }
228 
229  if( closest_dist == 0 || closest_dist < aClearance )
230  {
231  if( aLocation )
232  *aLocation = nearest;
233 
234  if( aActual )
235  *aActual = closest_dist;
236 
237  if( aMTV )
238  {
239  SHAPE_CIRCLE cmoved( aA );
240  VECTOR2I f_total( 0, 0 );
241 
242  VECTOR2I f;
243 
244  if (closest_mtv_seg >= 0)
245  {
246  SEG cs = aB.GetSegment( closest_mtv_seg );
247  VECTOR2I np = cs.NearestPoint( aA.GetCenter() );
248  f = ( np - aA.GetCenter() ) + ( np - aA.GetCenter() ).Resize( aA.GetRadius() );
249  }
250 
251  cmoved.SetCenter( cmoved.GetCenter() + f );
252  f_total += f;
253 
254  for( int s = 0; s < aB.GetSegmentCount(); s++ )
255  {
256  VECTOR2I f = pushoutForce( cmoved, aB.GetSegment( s ), aClearance );
257  cmoved.SetCenter( cmoved.GetCenter() + f );
258  f_total += f;
259  }
260 
261  *aMTV = f_total;
262  }
263 
264  return true;
265  }
266 
267  return false;
268 }
int Distance(const SEG &aSeg) const
Compute minimum Euclidean distance to segment aSeg.
Definition: seg.cpp:285
int GetRadius() const
Definition: shape_circle.h:107
virtual bool IsClosed() const =0
Define a general 2D-vector/point.
Definition: vector2d.h:61
const VECTOR2I GetCenter() const
Definition: shape_circle.h:112
virtual size_t GetSegmentCount() const =0
bool Collide(const SEG &aSeg, int aClearance=0, int *aActual=nullptr, VECTOR2I *aLocation=nullptr) const override
Check if the boundary of shape (this) lies closer to the segment aSeg than aClearance,...
Definition: shape_circle.h:76
bool PointInside(const VECTOR2I &aPt, int aAccuracy=0, bool aUseBBoxCache=false) const
Check if point aP lies inside a polygon (any type) defined by the line chain.
const VECTOR2I NearestPoint(const VECTOR2I &aP) const
Compute a point on the segment (this) that is closest to point aP.
Definition: seg.cpp:227
static VECTOR2I pushoutForce(const SHAPE_CIRCLE &aA, const SEG &aB, int aClearance)
Definition: seg.h:40
virtual const SEG GetSegment(int aIndex) const =0

References SHAPE_CIRCLE::Collide(), SEG::Distance(), SHAPE_CIRCLE::GetCenter(), SHAPE_CIRCLE::GetRadius(), SHAPE_LINE_CHAIN_BASE::GetSegment(), SHAPE_LINE_CHAIN_BASE::GetSegmentCount(), SHAPE_LINE_CHAIN_BASE::IsClosed(), SEG::NearestPoint(), SHAPE_LINE_CHAIN_BASE::PointInside(), pushoutForce(), and SHAPE_CIRCLE::SetCenter().

◆ Collide() [4/16]

static bool Collide ( const SHAPE_CIRCLE aA,
const SHAPE_SEGMENT aSeg,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 271 of file shape_collisions.cpp.

273 {
274  if( aA.Collide( aSeg.GetSeg(), aClearance + aSeg.GetWidth() / 2, aActual, aLocation ) )
275  {
276  if( aMTV )
277  *aMTV = -pushoutForce( aA, aSeg.GetSeg(), aClearance + aSeg.GetWidth() / 2);
278 
279  if( aActual )
280  *aActual = std::max( 0, *aActual - aSeg.GetWidth() / 2 );
281 
282  return true;
283  }
284 
285  return false;
286 }
const SEG & GetSeg() const
bool Collide(const SEG &aSeg, int aClearance=0, int *aActual=nullptr, VECTOR2I *aLocation=nullptr) const override
Check if the boundary of shape (this) lies closer to the segment aSeg than aClearance,...
Definition: shape_circle.h:76
static VECTOR2I pushoutForce(const SHAPE_CIRCLE &aA, const SEG &aB, int aClearance)
int GetWidth() const

References SHAPE_CIRCLE::Collide(), SHAPE_SEGMENT::GetSeg(), SHAPE_SEGMENT::GetWidth(), and pushoutForce().

◆ Collide() [5/16]

static bool Collide ( const SHAPE_LINE_CHAIN_BASE aA,
const SHAPE_LINE_CHAIN_BASE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 289 of file shape_collisions.cpp.

291 {
292  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
293  aA.Type(),
294  aB.Type() ) );
295 
296  int closest_dist = INT_MAX;
297  VECTOR2I nearest;
298 
299  if( aB.IsClosed() && aA.GetPointCount() > 0 && aB.PointInside( aA.GetPoint( 0 ) ) )
300  {
301  closest_dist = 0;
302  nearest = aA.GetPoint( 0 );
303  }
304  else
305  {
306  for( size_t i = 0; i < aB.GetSegmentCount(); i++ )
307  {
308  int collision_dist = 0;
309  VECTOR2I pn;
310 
311  if( aA.Collide( aB.GetSegment( i ), aClearance,
312  aActual || aLocation ? &collision_dist : nullptr,
313  aLocation ? &pn : nullptr ) )
314  {
315  if( collision_dist < closest_dist )
316  {
317  nearest = pn;
318  closest_dist = collision_dist;
319  }
320 
321  if( closest_dist == 0 )
322  break;
323 
324  // If we're not looking for aActual then any collision will do
325  if( !aActual )
326  break;
327  }
328  }
329  }
330 
331  if( closest_dist == 0 || closest_dist < aClearance )
332  {
333  if( aLocation )
334  *aLocation = nearest;
335 
336  if( aActual )
337  *aActual = closest_dist;
338 
339  return true;
340  }
341 
342  return false;
343 }
virtual bool IsClosed() const =0
Define a general 2D-vector/point.
Definition: vector2d.h:61
virtual size_t GetPointCount() const =0
virtual size_t GetSegmentCount() const =0
virtual bool Collide(const VECTOR2I &aP, int aClearance=0, int *aActual=nullptr, VECTOR2I *aLocation=nullptr) const override
Check if point aP lies closer to us than aClearance.
bool PointInside(const VECTOR2I &aPt, int aAccuracy=0, bool aUseBBoxCache=false) const
Check if point aP lies inside a polygon (any type) defined by the line chain.
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
virtual const SEG GetSegment(int aIndex) const =0
virtual const VECTOR2I GetPoint(int aIndex) const =0
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References SHAPE_LINE_CHAIN_BASE::Collide(), Format(), SHAPE_LINE_CHAIN_BASE::GetPoint(), SHAPE_LINE_CHAIN_BASE::GetPointCount(), SHAPE_LINE_CHAIN_BASE::GetSegment(), SHAPE_LINE_CHAIN_BASE::GetSegmentCount(), SHAPE_LINE_CHAIN_BASE::IsClosed(), SHAPE_LINE_CHAIN_BASE::PointInside(), and SHAPE_BASE::Type().

◆ Collide() [6/16]

static bool Collide ( const SHAPE_RECT aA,
const SHAPE_LINE_CHAIN_BASE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 346 of file shape_collisions.cpp.

348 {
349  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
350  aA.Type(),
351  aB.Type() ) );
352 
353  int closest_dist = INT_MAX;
354  VECTOR2I nearest;
355 
356  if( aB.IsClosed() && aB.PointInside( aA.Centre() ) )
357  {
358  nearest = aA.Centre();
359  closest_dist = 0;
360  }
361  else
362  {
363  for( size_t s = 0; s < aB.GetSegmentCount(); s++ )
364  {
365  int collision_dist = 0;
366  VECTOR2I pn;
367 
368  if( aA.Collide( aB.GetSegment( s ), aClearance,
369  aActual || aLocation ? &collision_dist : nullptr,
370  aLocation ? &pn : nullptr ) )
371  {
372  if( collision_dist < closest_dist )
373  {
374  nearest = pn;
375  closest_dist = collision_dist;
376  }
377 
378  if( closest_dist == 0 )
379  break;
380 
381  // If we're not looking for aActual then any collision will do
382  if( !aActual )
383  break;
384  }
385  }
386  }
387 
388  if( closest_dist == 0 || closest_dist < aClearance )
389  {
390  if( aLocation )
391  *aLocation = nearest;
392 
393  if( aActual )
394  *aActual = closest_dist;
395 
396  return true;
397  }
398 
399  return false;
400 }
bool Collide(const SHAPE *aShape, int aClearance, VECTOR2I *aMTV) const override
Check if the boundary of shape (this) lies closer to the shape aShape than aClearance,...
Definition: shape_rect.h:98
virtual bool IsClosed() const =0
Define a general 2D-vector/point.
Definition: vector2d.h:61
virtual VECTOR2I Centre() const
Compute a center-of-mass of the shape.
Definition: shape.h:216
virtual size_t GetSegmentCount() const =0
bool PointInside(const VECTOR2I &aPt, int aAccuracy=0, bool aUseBBoxCache=false) const
Check if point aP lies inside a polygon (any type) defined by the line chain.
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
virtual const SEG GetSegment(int aIndex) const =0
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References SHAPE::Centre(), SHAPE_RECT::Collide(), Format(), SHAPE_LINE_CHAIN_BASE::GetSegment(), SHAPE_LINE_CHAIN_BASE::GetSegmentCount(), SHAPE_LINE_CHAIN_BASE::IsClosed(), SHAPE_LINE_CHAIN_BASE::PointInside(), and SHAPE_BASE::Type().

◆ Collide() [7/16]

static bool Collide ( const SHAPE_RECT aA,
const SHAPE_SEGMENT aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 403 of file shape_collisions.cpp.

405 {
406  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
407  aA.Type(),
408  aB.Type() ) );
409 
410  bool rv = aA.Collide( aB.GetSeg(), aClearance + aB.GetWidth() / 2, aActual, aLocation );
411 
412  if( aActual )
413  *aActual = std::max( 0, *aActual - aB.GetWidth() / 2 );
414 
415  return rv;
416 }
bool Collide(const SHAPE *aShape, int aClearance, VECTOR2I *aMTV) const override
Check if the boundary of shape (this) lies closer to the shape aShape than aClearance,...
Definition: shape_rect.h:98
const SEG & GetSeg() const
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
int GetWidth() const
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References SHAPE_RECT::Collide(), Format(), SHAPE_SEGMENT::GetSeg(), SHAPE_SEGMENT::GetWidth(), and SHAPE_BASE::Type().

◆ Collide() [8/16]

static bool Collide ( const SHAPE_SEGMENT aA,
const SHAPE_SEGMENT aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 419 of file shape_collisions.cpp.

421 {
422  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
423  aA.Type(),
424  aB.Type() ) );
425 
426  bool rv = aA.Collide( aB.GetSeg(), aClearance + aB.GetWidth() / 2, aActual, aLocation );
427 
428  if( aActual )
429  *aActual = std::max( 0, *aActual - aB.GetWidth() / 2 );
430 
431  return rv;
432 }
const SEG & GetSeg() const
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
int GetWidth() const
bool Collide(const SHAPE *aShape, int aClearance, VECTOR2I *aMTV) const override
Check if the boundary of shape (this) lies closer to the shape aShape than aClearance,...
Definition: shape_segment.h:67
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References SHAPE_SEGMENT::Collide(), Format(), SHAPE_SEGMENT::GetSeg(), SHAPE_SEGMENT::GetWidth(), and SHAPE_BASE::Type().

◆ Collide() [9/16]

static bool Collide ( const SHAPE_LINE_CHAIN_BASE aA,
const SHAPE_SEGMENT aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 435 of file shape_collisions.cpp.

437 {
438  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
439  aA.Type(),
440  aB.Type() ) );
441 
442  bool rv = aA.Collide( aB.GetSeg(), aClearance + aB.GetWidth() / 2, aActual, aLocation );
443 
444  if( aActual )
445  *aActual = std::max( 0, *aActual - aB.GetWidth() / 2 );
446 
447  return rv;
448 }
const SEG & GetSeg() const
virtual bool Collide(const VECTOR2I &aP, int aClearance=0, int *aActual=nullptr, VECTOR2I *aLocation=nullptr) const override
Check if point aP lies closer to us than aClearance.
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
int GetWidth() const
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References SHAPE_LINE_CHAIN_BASE::Collide(), Format(), SHAPE_SEGMENT::GetSeg(), SHAPE_SEGMENT::GetWidth(), and SHAPE_BASE::Type().

◆ Collide() [10/16]

static bool Collide ( const SHAPE_RECT aA,
const SHAPE_RECT aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 451 of file shape_collisions.cpp.

453 {
454  return Collide( aA.Outline(), aB.Outline(), aClearance, aActual, aLocation, aMTV );
455 }
const SHAPE_LINE_CHAIN Outline() const
Definition: shape_rect.h:170
static bool Collide(const SHAPE_CIRCLE &aA, const SHAPE_CIRCLE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)

References Collide(), and SHAPE_RECT::Outline().

◆ Collide() [11/16]

static bool Collide ( const SHAPE_ARC aA,
const SHAPE_RECT aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 458 of file shape_collisions.cpp.

460 {
461  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
462  aA.Type(),
463  aB.Type() ) );
464 
465  const SHAPE_LINE_CHAIN lc = aA.ConvertToPolyline();
466 
467  bool rv = Collide( lc, aB.Outline(), aClearance + aA.GetWidth() / 2, aActual, aLocation, aMTV );
468 
469  if( rv && aActual )
470  *aActual = std::max( 0, *aActual - aA.GetWidth() / 2 );
471 
472  return rv;
473 }
const SHAPE_LINE_CHAIN Outline() const
Definition: shape_rect.h:170
static bool Collide(const SHAPE_CIRCLE &aA, const SHAPE_CIRCLE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
int GetWidth() const
Definition: shape_arc.h:156
const SHAPE_LINE_CHAIN ConvertToPolyline(double aAccuracy=DefaultAccuracyForPCB(), double *aEffectiveAccuracy=nullptr) const
Construct a SHAPE_LINE_CHAIN of segments from a given arc.
Definition: shape_arc.cpp:498
Represent a polyline (an zero-thickness chain of connected line segments).
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References Collide(), SHAPE_ARC::ConvertToPolyline(), Format(), SHAPE_ARC::GetWidth(), SHAPE_RECT::Outline(), and SHAPE_BASE::Type().

◆ Collide() [12/16]

static bool Collide ( const SHAPE_ARC aA,
const SHAPE_CIRCLE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 476 of file shape_collisions.cpp.

478 {
479  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
480  aA.Type(),
481  aB.Type() ) );
482 
483  const SHAPE_LINE_CHAIN lc = aA.ConvertToPolyline();
484 
485  bool rv = Collide( aB, lc, aClearance + aA.GetWidth() / 2, aActual, aLocation, aMTV );
486 
487  if( rv && aActual )
488  *aActual = std::max( 0, *aActual - aA.GetWidth() / 2 );
489 
490  return rv;
491 }
static bool Collide(const SHAPE_CIRCLE &aA, const SHAPE_CIRCLE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
int GetWidth() const
Definition: shape_arc.h:156
const SHAPE_LINE_CHAIN ConvertToPolyline(double aAccuracy=DefaultAccuracyForPCB(), double *aEffectiveAccuracy=nullptr) const
Construct a SHAPE_LINE_CHAIN of segments from a given arc.
Definition: shape_arc.cpp:498
Represent a polyline (an zero-thickness chain of connected line segments).
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References Collide(), SHAPE_ARC::ConvertToPolyline(), Format(), SHAPE_ARC::GetWidth(), and SHAPE_BASE::Type().

◆ Collide() [13/16]

static bool Collide ( const SHAPE_ARC aA,
const SHAPE_LINE_CHAIN aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 494 of file shape_collisions.cpp.

496 {
497  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
498  aA.Type(),
499  aB.Type() ) );
500 
501  const SHAPE_LINE_CHAIN lc = aA.ConvertToPolyline();
502 
503  bool rv = Collide( lc, aB, aClearance + aA.GetWidth() / 2, aActual, aLocation, aMTV );
504 
505  if( rv && aActual )
506  *aActual = std::max( 0, *aActual - aA.GetWidth() / 2 );
507 
508  return rv;
509 }
static bool Collide(const SHAPE_CIRCLE &aA, const SHAPE_CIRCLE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
int GetWidth() const
Definition: shape_arc.h:156
const SHAPE_LINE_CHAIN ConvertToPolyline(double aAccuracy=DefaultAccuracyForPCB(), double *aEffectiveAccuracy=nullptr) const
Construct a SHAPE_LINE_CHAIN of segments from a given arc.
Definition: shape_arc.cpp:498
Represent a polyline (an zero-thickness chain of connected line segments).
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References Collide(), SHAPE_ARC::ConvertToPolyline(), Format(), SHAPE_ARC::GetWidth(), and SHAPE_BASE::Type().

◆ Collide() [14/16]

static bool Collide ( const SHAPE_ARC aA,
const SHAPE_SEGMENT aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 512 of file shape_collisions.cpp.

514 {
515  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
516  aA.Type(),
517  aB.Type() ) );
518 
519  const SHAPE_LINE_CHAIN lc = aA.ConvertToPolyline();
520 
521  bool rv = Collide( lc, aB, aClearance + aA.GetWidth() / 2, aActual, aLocation, aMTV );
522 
523  if( rv && aActual )
524  *aActual = std::max( 0, *aActual - aA.GetWidth() / 2 );
525 
526  return rv;
527 }
static bool Collide(const SHAPE_CIRCLE &aA, const SHAPE_CIRCLE &aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
int GetWidth() const
Definition: shape_arc.h:156
const SHAPE_LINE_CHAIN ConvertToPolyline(double aAccuracy=DefaultAccuracyForPCB(), double *aEffectiveAccuracy=nullptr) const
Construct a SHAPE_LINE_CHAIN of segments from a given arc.
Definition: shape_arc.cpp:498
Represent a polyline (an zero-thickness chain of connected line segments).
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References Collide(), SHAPE_ARC::ConvertToPolyline(), Format(), SHAPE_ARC::GetWidth(), and SHAPE_BASE::Type().

◆ Collide() [15/16]

static bool Collide ( const SHAPE_ARC aA,
const SHAPE_LINE_CHAIN_BASE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 530 of file shape_collisions.cpp.

532 {
533  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
534  aA.Type(),
535  aB.Type() ) );
536 
537  int closest_dist = INT_MAX;
538  VECTOR2I nearest;
539 
540  if( aB.IsClosed() && aB.PointInside( aA.GetP0() ) )
541  {
542  closest_dist = 0;
543  nearest = aA.GetP0();
544  }
545  else
546  {
547  for( size_t i = 0; i < aB.GetSegmentCount(); i++ )
548  {
549  int collision_dist = 0;
550  VECTOR2I pn;
551 
552  if( aA.Collide( aB.GetSegment( i ), aClearance,
553  aActual || aLocation ? &collision_dist : nullptr,
554  aLocation ? &pn : nullptr ) )
555  {
556  if( collision_dist < closest_dist )
557  {
558  nearest = pn;
559  closest_dist = collision_dist;
560  }
561 
562  if( closest_dist == 0 )
563  break;
564 
565  // If we're not looking for aActual then any collision will do
566  if( !aActual )
567  break;
568  }
569  }
570  }
571 
572  if( closest_dist == 0 || closest_dist < aClearance )
573  {
574  if( aLocation )
575  *aLocation = nearest;
576 
577  if( aActual )
578  *aActual = closest_dist;
579 
580  return true;
581  }
582 
583  return false;
584 }
bool Collide(const SEG &aSeg, int aClearance=0, int *aActual=nullptr, VECTOR2I *aLocation=nullptr) const override
Check if the boundary of shape (this) lies closer to the segment aSeg than aClearance,...
Definition: shape_arc.cpp:229
virtual bool IsClosed() const =0
Define a general 2D-vector/point.
Definition: vector2d.h:61
virtual size_t GetSegmentCount() const =0
const VECTOR2I & GetP0() const
Definition: shape_arc.h:111
bool PointInside(const VECTOR2I &aPt, int aAccuracy=0, bool aUseBBoxCache=false) const
Check if point aP lies inside a polygon (any type) defined by the line chain.
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
virtual const SEG GetSegment(int aIndex) const =0
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References SHAPE_ARC::Collide(), Format(), SHAPE_ARC::GetP0(), SHAPE_LINE_CHAIN_BASE::GetSegment(), SHAPE_LINE_CHAIN_BASE::GetSegmentCount(), SHAPE_LINE_CHAIN_BASE::IsClosed(), SHAPE_LINE_CHAIN_BASE::PointInside(), and SHAPE_BASE::Type().

◆ Collide() [16/16]

static bool Collide ( const SHAPE_ARC aA,
const SHAPE_ARC aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
inlinestatic

Definition at line 587 of file shape_collisions.cpp.

589 {
590  wxASSERT_MSG( !aMTV, wxString::Format( "MTV not implemented for %s : %s collisions",
591  aA.Type(),
592  aB.Type() ) );
593 
594  SEG mediatrix( aA.GetCenter(), aB.GetCenter() );
595 
596  std::vector<VECTOR2I> ips;
597 
598  // Basic case - arcs intersect
599  if( aA.Intersect( aB, &ips ) > 0 )
600  {
601  if( aActual )
602  *aActual = 0;
603 
604  if( aLocation )
605  *aLocation = ips[0]; // Pick the first intersection point
606 
607  return true;
608  }
609 
610  // Arcs don't intersect, build a list of points to check
611  std::vector<VECTOR2I> ptsA;
612  std::vector<VECTOR2I> ptsB;
613 
614  bool cocentered = ( mediatrix.A == mediatrix.B );
615 
616  // 1: Interior points of both arcs, which are on the line segment between the two centres
617  if( !cocentered )
618  {
619  aA.IntersectLine( mediatrix, &ptsA );
620  aB.IntersectLine( mediatrix, &ptsB );
621  }
622 
623  // 2: Check arc end points
624  ptsA.push_back( aA.GetP0() );
625  ptsA.push_back( aA.GetP1() );
626  ptsB.push_back( aB.GetP0() );
627  ptsB.push_back( aB.GetP1() );
628 
629  // 3: Endpoint of one and "projected" point on the other, which is on the
630  // line segment through that endpoint and the centre of the other arc
631  aA.IntersectLine( SEG( aB.GetP0(), aA.GetCenter() ), &ptsA );
632  aA.IntersectLine( SEG( aB.GetP1(), aA.GetCenter() ), &ptsA );
633 
634  aB.IntersectLine( SEG( aA.GetP0(), aB.GetCenter() ), &ptsB );
635  aB.IntersectLine( SEG( aA.GetP1(), aB.GetCenter() ), &ptsB );
636 
637  double minDist = std::numeric_limits<double>::max();
638  SEG minDistSeg;
639  bool rv = false;
640 
641  int widths = ( aA.GetWidth() / 2 ) + ( aB.GetWidth() / 2 );
642 
643  // @todo performance could be improved by only checking certain points (e.g only check end
644  // points against other end points or their corresponding "projected" points)
645  for( const VECTOR2I& ptA : ptsA )
646  {
647  for( const VECTOR2I& ptB : ptsB )
648  {
649  SEG candidateMinDist( ptA, ptB );
650  int dist = candidateMinDist.Length() - widths;
651 
652  if( dist < aClearance )
653  {
654  if( !rv || dist < minDist )
655  {
656  minDist = dist;
657  minDistSeg = candidateMinDist;
658  }
659 
660  rv = true;
661  }
662  }
663  }
664 
665  if( rv && aActual )
666  *aActual = std::max( 0, minDistSeg.Length() - widths );
667 
668  if( rv && aLocation )
669  *aLocation = minDistSeg.Center();
670 
671  return rv;
672 }
int Length() const
Return the length (this).
Definition: seg.h:350
Define a general 2D-vector/point.
Definition: vector2d.h:61
VECTOR2I Center() const
Definition: seg.h:386
int Intersect(const SHAPE_ARC &aArc, std::vector< VECTOR2I > *aIpsBuffer) const
Find intersection points between this arc and aArc.
Definition: shape_arc.cpp:319
const VECTOR2I & GetP0() const
Definition: shape_arc.h:111
int IntersectLine(const SEG &aSeg, std::vector< VECTOR2I > *aIpsBuffer) const
Find intersection points between this arc and aSeg, treating aSeg as an infinite line.
Definition: shape_arc.cpp:301
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
Definition: seg.h:40
int GetWidth() const
Definition: shape_arc.h:156
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94
const VECTOR2I & GetP1() const
Definition: shape_arc.h:112
VECTOR2I GetCenter() const
Definition: shape_arc.cpp:464

References SEG::Center(), Format(), SHAPE_ARC::GetCenter(), SHAPE_ARC::GetP0(), SHAPE_ARC::GetP1(), SHAPE_ARC::GetWidth(), SHAPE_ARC::Intersect(), SHAPE_ARC::IntersectLine(), SEG::Length(), and SHAPE_BASE::Type().

◆ collideShapes()

static bool collideShapes ( const SHAPE aA,
const SHAPE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
static

Definition at line 899 of file shape_collisions.cpp.

901 {
902  int currentActual = std::numeric_limits<int>::max();
903  VECTOR2I currentLocation;
904  VECTOR2I currentMTV(0, 0);
905  bool colliding = false;
906 
907  auto canExit =
908  [&]()
909  {
910  if( !colliding )
911  return false;
912 
913  if( aActual && currentActual > 0 )
914  return false;
915 
916  if( aMTV )
917  return false;
918 
919  return true;
920  };
921 
922  auto collideCompoundSubshapes =
923  [&]( const SHAPE* elemA, const SHAPE* elemB, int clearance ) -> bool
924  {
925  int actual = 0;
926  VECTOR2I location;
927  VECTOR2I mtv;
928 
929  if( collideSingleShapes( elemA, elemB, clearance,
930  aActual || aLocation ? &actual : nullptr,
931  aLocation ? &location : nullptr,
932  aMTV ? &mtv : nullptr ) )
933  {
934  if( actual < currentActual )
935  {
936  currentActual = actual;
937  currentLocation = location;
938  }
939 
940  if( aMTV && mtv.SquaredEuclideanNorm() > currentMTV.SquaredEuclideanNorm() )
941  {
942  currentMTV = mtv;
943  }
944 
945  return true;
946  }
947 
948  return false;
949  };
950 
951  if( aA->Type() == SH_COMPOUND && aB->Type() == SH_COMPOUND )
952  {
953  const SHAPE_COMPOUND* cmpA = static_cast<const SHAPE_COMPOUND*>( aA );
954  const SHAPE_COMPOUND* cmpB = static_cast<const SHAPE_COMPOUND*>( aB );
955 
956  for( const SHAPE* elemA : cmpA->Shapes() )
957  {
958  for( const SHAPE* elemB : cmpB->Shapes() )
959  {
960  if( collideCompoundSubshapes( elemA, elemB, aClearance ) )
961  {
962  colliding = true;
963 
964  if( canExit() )
965  break;
966  }
967  }
968 
969  if( canExit() )
970  break;
971  }
972  }
973  else if( aA->Type() == SH_COMPOUND )
974  {
975  const SHAPE_COMPOUND* cmpA = static_cast<const SHAPE_COMPOUND*>( aA );
976 
977  for( const SHAPE* elemA : cmpA->Shapes() )
978  {
979  if( collideCompoundSubshapes( elemA, aB, aClearance ) )
980  {
981  colliding = true;
982 
983  if( canExit() )
984  break;
985  }
986  }
987  }
988  else if( aB->Type() == SH_COMPOUND )
989  {
990  const SHAPE_COMPOUND* cmpB = static_cast<const SHAPE_COMPOUND*>( aB );
991 
992  for( const SHAPE* elemB : cmpB->Shapes() )
993  {
994  if( collideCompoundSubshapes( aA, elemB, aClearance ) )
995  {
996  colliding = true;
997 
998  if( canExit() )
999  break;
1000  }
1001  }
1002  }
1003  else
1004  {
1005  return collideSingleShapes( aA, aB, aClearance, aActual, aLocation, aMTV );
1006  }
1007 
1008  if( colliding )
1009  {
1010  if( aLocation )
1011  *aLocation = currentLocation;
1012 
1013  if( aActual )
1014  *aActual = currentActual;
1015 
1016  if( aMTV )
1017  *aMTV = currentMTV;
1018  }
1019 
1020  return colliding;
1021 }
compound shape, consisting of multiple simple shapes
Definition: shape.h:49
Define a general 2D-vector/point.
Definition: vector2d.h:61
An abstract shape on 2D plane.
Definition: shape.h:116
const std::vector< SHAPE * > & Shapes() const
static bool collideSingleShapes(const SHAPE *aA, const SHAPE *aB, int aClearance, int *aActual, VECTOR2I *aLocation, VECTOR2I *aMTV)
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94

References collideSingleShapes(), SH_COMPOUND, SHAPE_COMPOUND::Shapes(), VECTOR2< T >::SquaredEuclideanNorm(), and SHAPE_BASE::Type().

Referenced by SHAPE::Collide().

◆ collideSingleShapes()

static bool collideSingleShapes ( const SHAPE aA,
const SHAPE aB,
int  aClearance,
int *  aActual,
VECTOR2I aLocation,
VECTOR2I aMTV 
)
static

Definition at line 699 of file shape_collisions.cpp.

701 {
702  switch( aA->Type() )
703  {
704  case SH_NULL:
705  return false;
706 
707  case SH_RECT:
708  switch( aB->Type() )
709  {
710  case SH_RECT:
711  return CollCase<SHAPE_RECT, SHAPE_RECT>( aA, aB, aClearance, aActual, aLocation, aMTV );
712 
713  case SH_CIRCLE:
714  return CollCase<SHAPE_RECT, SHAPE_CIRCLE>( aA, aB, aClearance, aActual, aLocation, aMTV );
715 
716  case SH_LINE_CHAIN:
717  return CollCase<SHAPE_RECT, SHAPE_LINE_CHAIN>( aA, aB, aClearance, aActual, aLocation, aMTV );
718 
719  case SH_SEGMENT:
720  return CollCase<SHAPE_RECT, SHAPE_SEGMENT>( aA, aB, aClearance, aActual, aLocation, aMTV );
721 
722  case SH_SIMPLE:
724  return CollCase<SHAPE_RECT, SHAPE_LINE_CHAIN_BASE>( aA, aB, aClearance, aActual, aLocation, aMTV );
725 
726  case SH_ARC:
727  return CollCaseReversed<SHAPE_RECT, SHAPE_ARC>( aA, aB, aClearance, aActual, aLocation, aMTV );
728 
729  case SH_NULL:
730  return false;
731 
732  default:
733  break;
734  }
735  break;
736 
737  case SH_CIRCLE:
738  switch( aB->Type() )
739  {
740  case SH_RECT:
741  return CollCaseReversed<SHAPE_CIRCLE, SHAPE_RECT>( aA, aB, aClearance, aActual, aLocation, aMTV );
742 
743  case SH_CIRCLE:
744  return CollCase<SHAPE_CIRCLE, SHAPE_CIRCLE>( aA, aB, aClearance, aActual, aLocation, aMTV );
745 
746  case SH_LINE_CHAIN:
747  return CollCase<SHAPE_CIRCLE, SHAPE_LINE_CHAIN>( aA, aB, aClearance, aActual, aLocation, aMTV );
748 
749  case SH_SEGMENT:
750  return CollCase<SHAPE_CIRCLE, SHAPE_SEGMENT>( aA, aB, aClearance, aActual, aLocation, aMTV );
751 
752  case SH_SIMPLE:
754  return CollCase<SHAPE_CIRCLE, SHAPE_LINE_CHAIN_BASE>( aA, aB, aClearance, aActual, aLocation, aMTV );
755 
756  case SH_ARC:
757  return CollCaseReversed<SHAPE_CIRCLE, SHAPE_ARC>( aA, aB, aClearance, aActual, aLocation, aMTV );
758 
759  case SH_NULL:
760  return false;
761 
762  default:
763  break;
764  }
765  break;
766 
767  case SH_LINE_CHAIN:
768  switch( aB->Type() )
769  {
770  case SH_RECT:
771  return CollCase<SHAPE_RECT, SHAPE_LINE_CHAIN>( aB, aA, aClearance, aActual, aLocation, aMTV );
772 
773  case SH_CIRCLE:
774  return CollCase<SHAPE_CIRCLE, SHAPE_LINE_CHAIN>( aB, aA, aClearance, aActual, aLocation, aMTV );
775 
776  case SH_LINE_CHAIN:
777  return CollCase<SHAPE_LINE_CHAIN, SHAPE_LINE_CHAIN>( aA, aB, aClearance, aActual, aLocation, aMTV );
778 
779  case SH_SEGMENT:
780  return CollCase<SHAPE_LINE_CHAIN, SHAPE_SEGMENT>( aA, aB, aClearance, aActual, aLocation, aMTV );
781 
782  case SH_SIMPLE:
784  return CollCase<SHAPE_LINE_CHAIN, SHAPE_LINE_CHAIN_BASE>( aA, aB, aClearance, aActual, aLocation, aMTV );
785 
786  case SH_ARC:
787  return CollCaseReversed<SHAPE_LINE_CHAIN, SHAPE_ARC>( aA, aB, aClearance, aActual, aLocation, aMTV );
788 
789  case SH_NULL:
790  return false;
791 
792  default:
793  break;
794  }
795  break;
796 
797  case SH_SEGMENT:
798  switch( aB->Type() )
799  {
800  case SH_RECT:
801  return CollCase<SHAPE_RECT, SHAPE_SEGMENT>( aB, aA, aClearance, aActual, aLocation, aMTV );
802 
803  case SH_CIRCLE:
804  return CollCaseReversed<SHAPE_SEGMENT, SHAPE_CIRCLE>( aA, aB, aClearance, aActual, aLocation, aMTV );
805 
806  case SH_LINE_CHAIN:
807  return CollCase<SHAPE_LINE_CHAIN, SHAPE_SEGMENT>( aB, aA, aClearance, aActual, aLocation, aMTV );
808 
809  case SH_SEGMENT:
810  return CollCase<SHAPE_SEGMENT, SHAPE_SEGMENT>( aA, aB, aClearance, aActual, aLocation, aMTV );
811 
812  case SH_SIMPLE:
814  return CollCase<SHAPE_LINE_CHAIN_BASE, SHAPE_SEGMENT>( aB, aA, aClearance, aActual, aLocation, aMTV );
815 
816  case SH_ARC:
817  return CollCaseReversed<SHAPE_SEGMENT, SHAPE_ARC>( aA, aB, aClearance, aActual, aLocation, aMTV );
818 
819  case SH_NULL:
820  return false;
821 
822  default:
823  break;
824  }
825  break;
826 
827  case SH_SIMPLE:
829  switch( aB->Type() )
830  {
831  case SH_RECT:
832  return CollCase<SHAPE_RECT, SHAPE_LINE_CHAIN_BASE>( aB, aA, aClearance, aActual, aLocation, aMTV );
833 
834  case SH_CIRCLE:
835  return CollCase<SHAPE_CIRCLE, SHAPE_LINE_CHAIN_BASE>( aB, aA, aClearance, aActual, aLocation, aMTV );
836 
837  case SH_LINE_CHAIN:
838  return CollCase<SHAPE_LINE_CHAIN, SHAPE_LINE_CHAIN_BASE>( aB, aA, aClearance, aActual, aLocation, aMTV );
839 
840  case SH_SEGMENT:
841  return CollCase<SHAPE_LINE_CHAIN_BASE, SHAPE_SEGMENT>( aA, aB, aClearance, aActual, aLocation, aMTV );
842 
843  case SH_SIMPLE:
845  return CollCase<SHAPE_LINE_CHAIN_BASE, SHAPE_LINE_CHAIN_BASE>( aA, aB, aClearance, aActual, aLocation, aMTV );
846 
847  case SH_ARC:
848  return CollCaseReversed<SHAPE_LINE_CHAIN_BASE, SHAPE_ARC>( aA, aB, aClearance, aActual, aLocation, aMTV );
849 
850  case SH_NULL:
851  return false;
852 
853  default:
854  break;
855  }
856  break;
857 
858  case SH_ARC:
859  switch( aB->Type() )
860  {
861  case SH_RECT:
862  return CollCase<SHAPE_ARC, SHAPE_RECT>( aA, aB, aClearance, aActual, aLocation, aMTV );
863 
864  case SH_CIRCLE:
865  return CollCase<SHAPE_ARC, SHAPE_CIRCLE>( aA, aB, aClearance, aActual, aLocation, aMTV );
866 
867  case SH_LINE_CHAIN:
868  return CollCase<SHAPE_ARC, SHAPE_LINE_CHAIN>( aA, aB, aClearance, aActual, aLocation, aMTV );
869 
870  case SH_SEGMENT:
871  return CollCase<SHAPE_ARC, SHAPE_SEGMENT>( aA, aB, aClearance, aActual, aLocation, aMTV );
872 
873  case SH_SIMPLE:
875  return CollCase<SHAPE_ARC, SHAPE_LINE_CHAIN_BASE>( aA, aB, aClearance, aActual, aLocation, aMTV );
876 
877  case SH_ARC:
878  return CollCase<SHAPE_ARC, SHAPE_ARC>( aA, aB, aClearance, aActual, aLocation, aMTV );
879 
880  case SH_NULL:
881  return false;
882 
883  default:
884  break;
885  }
886  break;
887 
888  default:
889  break;
890  }
891 
892  wxFAIL_MSG( wxString::Format( "Unsupported collision: %s with %s",
893  SHAPE_TYPE_asString( aA->Type() ),
894  SHAPE_TYPE_asString( aB->Type() ) ) );
895 
896  return false;
897 }
static wxString SHAPE_TYPE_asString(SHAPE_TYPE a)
Definition: shape.h:55
circular arc
Definition: shape.h:50
circle
Definition: shape.h:46
void Format(OUTPUTFORMATTER *out, int aNestLevel, int aCtl, const CPTREE &aTree)
Output a PTREE into s-expression format via an OUTPUTFORMATTER derivative.
Definition: ptree.cpp:200
a single triangle belonging to a POLY_SET triangulation
Definition: shape.h:52
empty shape (no shape...),
Definition: shape.h:51
line chain (polyline)
Definition: shape.h:45
axis-aligned rectangle
Definition: shape.h:43
simple polygon
Definition: shape.h:47
SHAPE_TYPE Type() const
Return the type of the shape.
Definition: shape.h:94
line segment
Definition: shape.h:44

References Format(), SH_ARC, SH_CIRCLE, SH_LINE_CHAIN, SH_NULL, SH_POLY_SET_TRIANGLE, SH_RECT, SH_SEGMENT, SH_SIMPLE, SHAPE_TYPE_asString(), and SHAPE_BASE::Type().

Referenced by collideShapes().

◆ pushoutForce()

static VECTOR2I pushoutForce ( const SHAPE_CIRCLE aA,
const SEG aB,
int  aClearance 
)
static

Definition at line 147 of file shape_collisions.cpp.

148 {
149  VECTOR2I f( 0, 0 );
150 
151  const VECTOR2I c = aA.GetCenter();
152  const VECTOR2I nearest = aB.NearestPoint( c );
153 
154  const int r = aA.GetRadius();
155 
156  int dist = ( nearest - c ).EuclideanNorm();
157  int min_dist = aClearance + r;
158 
159  if( dist < min_dist )
160  {
161  for( int corr = 0; corr < 5; corr++ )
162  {
163  f = ( aA.GetCenter() - nearest ).Resize( min_dist - dist + corr );
164 
165  if( aB.Distance( c + f ) >= min_dist )
166  break;
167  }
168  }
169 
170  return f;
171 }
double EuclideanNorm(const wxPoint &vector)
Euclidean norm of a 2D vector.
Definition: trigo.h:146
int Distance(const SEG &aSeg) const
Compute minimum Euclidean distance to segment aSeg.
Definition: seg.cpp:285
int GetRadius() const
Definition: shape_circle.h:107
Define a general 2D-vector/point.
Definition: vector2d.h:61
const VECTOR2I GetCenter() const
Definition: shape_circle.h:112
const VECTOR2I NearestPoint(const VECTOR2I &aP) const
Compute a point on the segment (this) that is closest to point aP.
Definition: seg.cpp:227
E_SERIE r
Definition: eserie.cpp:41

References SEG::Distance(), EuclideanNorm(), SHAPE_CIRCLE::GetCenter(), SHAPE_CIRCLE::GetRadius(), SEG::NearestPoint(), and r.

Referenced by Collide().