123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596 |
- #pragma once
- #include <Mathematics/IntrAlignedBox2Circle2.h>
- #include <Mathematics/DistPointOrientedBox.h>
- namespace WwiseGTE
- {
- template <typename Real>
- class TIQuery<Real, OrientedBox2<Real>, Circle2<Real>>
- {
- public:
-
-
-
-
-
- struct Result
- {
- bool intersect;
- };
- Result operator()(OrientedBox2<Real> const& box, Circle2<Real> const& circle)
- {
- DCPQuery<Real, Vector2<Real>, OrientedBox2<Real>> pbQuery;
- auto pbResult = pbQuery(circle.center, box);
- Result result;
- result.intersect = (pbResult.sqrDistance <= circle.radius * circle.radius);
- return result;
- }
- };
- template <typename Real>
- class FIQuery<Real, OrientedBox2<Real>, Circle2<Real>>
- :
- public FIQuery<Real, AlignedBox2<Real>, Circle2<Real>>
- {
- public:
-
- typename FIQuery<Real, AlignedBox2<Real>, Circle2<Real>>::Result
- operator()(OrientedBox2<Real> const& box, Vector2<Real> const& boxVelocity,
- Circle2<Real> const& circle, Vector2<Real> const& circleVelocity)
- {
-
-
-
- Real const zero(0), one(1), minusOne(-1);
- Vector2<Real> cdiff = circle.center - box.center;
- Vector2<Real> vdiff = circleVelocity - boxVelocity;
- Vector2<Real> C, V;
- for (int i = 0; i < 2; ++i)
- {
- C[i] = Dot(cdiff, box.axis[i]);
- V[i] = Dot(vdiff, box.axis[i]);
- }
-
-
- Real sign[2];
- for (int i = 0; i < 2; ++i)
- {
- if (C[i] >= zero)
- {
- sign[i] = one;
- }
- else
- {
- C[i] = -C[i];
- V[i] = -V[i];
- sign[i] = minusOne;
- }
- }
- typename FIQuery<Real, AlignedBox2<Real>, Circle2<Real>>::Result result = { 0, zero, { zero, zero } };
- this->DoQuery(box.extent, C, circle.radius, V, result);
- if (result.intersectionType != 0)
- {
-
- result.contactPoint = box.center
- + (sign[0] * result.contactPoint[0]) * box.axis[0]
- + (sign[1] * result.contactPoint[1]) * box.axis[1];
- }
- return result;
- }
- };
- }
|