Home Explore Help
Sign In
cpp
/
EsenthalEngine
mirror of https://github.com/feiyunwill/EsenthelEngine.git
2
0
Fork 0
Files Issues 0 Wiki
Branch: development
Branches Tags
EsenthalEngine
/
Engine
/
H
/
Math
/
Shapes
/
Ball.h

Ball.h 8.3 KB
Permalink History Raw

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138 
  1. /******************************************************************************
    2. 

  2. 

  3.    Use 'Ball'  to handle ball shapes, Flt type
    4. 

  4.    Use 'BallD' to handle ball shapes, Dbl type
    5. 

  5. 

  6. /******************************************************************************/
    7. 

  7. struct Ball // Ball Shape
    8. 

  8. {
    9. 

  9.    Flt r  ; // radius
    10. 

  10.    Vec pos; // center position
    11. 

  11. 

  12.    Ball& zero(                         ) {T.r=0; T.pos.zero(); return T;}
    13. 

  13.    Ball& set (Flt r, C Vec &pos=VecZero) {T.r=r; T.pos=pos   ; return T;}
    14. 

  14. 

  15. #if EE_PRIVATE
    16. 

  16.    Ball& setAnimated(C Extent &ext, C Matrix           &matrix   ); // set ball from 'ext' animated by 'matrix'
    17. 

  17. #endif
    18. 

  18.    Ball& setAnimated(C Extent &ext, C AnimatedSkeleton &anim_skel); // set approximate ball encapsulating 'ext' animated by 'anim_skel' skeleton
    19. 

  19. 

  20.    Ball& operator+=(C Vec     &v) {pos+=v; return T;}
    21. 

  21.    Ball& operator-=(C Vec     &v) {pos-=v; return T;}
    22. 

  22.    Ball& operator*=(  Flt      f);
    23. 

  23.    Ball& operator/=(  Flt      f);
    24. 

  24.    Ball& operator*=(C Matrix3 &m);
    25. 

  25.    Ball& operator/=(C Matrix3 &m);
    26. 

  26.    Ball& operator*=(C Matrix  &m);
    27. 

  27.    Ball& operator/=(C Matrix  &m);
    28. 

  28. 

  29.    friend Ball operator+ (C Ball &ball, C Vec     &v) {return Ball(ball)+=v;}
    30. 

  30.    friend Ball operator- (C Ball &ball, C Vec     &v) {return Ball(ball)-=v;}
    31. 

  31.    friend Ball operator* (C Ball &ball,   Flt      f) {return Ball(ball)*=f;}
    32. 

  32.    friend Ball operator/ (C Ball &ball,   Flt      f) {return Ball(ball)/=f;}
    33. 

  33.    friend Ball operator* (C Ball &ball, C Matrix3 &m) {return Ball(ball)*=m;}
    34. 

  34.    friend Ball operator/ (C Ball &ball, C Matrix3 &m) {return Ball(ball)/=m;}
    35. 

  35.    friend Ball operator* (C Ball &ball, C Matrix  &m) {return Ball(ball)*=m;}
    36. 

  36.    friend Ball operator/ (C Ball &ball, C Matrix  &m) {return Ball(ball)/=m;}
    37. 

  37. 

  38.    // get
    39. 

  39.    Flt area  ()C {return (PI*4  )*r*r  ;} // get surface area
    40. 

  40.    Flt volume()C {return (PI*4/3)*r*r*r;} // get volume
    41. 

  41. 

  42.    Vec nearest(C Vec &normal)C; // get nearest point on ball towards normal
    43. 

  43. 

  44.    Str asText()C {return S+"Radius: "+r+", Pos: "+pos;} // get text description
    45. 

  45. 

  46.    // operations
    47. 

  47.    Ball& extend(Flt e) {r+=e; return T;} // extend
    48. 

  48.    Bool  from  (C Vec *point, Int points                  ); // set ball from an array of points                        , false on fail (if there are no points)
    49. 

  49.    Bool  from  (C Vec *point, Int points, C Matrix &matrix); // set ball from an array of points transformed by 'matrix', false on fail (if there are no points)
    50. 

  50. 

  51.    // draw
    52. 

  52. #if EE_PRIVATE
    53. 

  53.    void drawVI   (                                                   Bool fill=false, C VecI2 &resolution=VecI2(-1))C; // draw, this relies on active object matrix which can be set using 'SetMatrix' function
    54. 

  54. #endif
    55. 

  55.    void draw     (C Color &color=WHITE,                              Bool fill=false, C VecI2 &resolution=VecI2(-1))C; // draw                  , this relies on active object matrix which can be set using 'SetMatrix' function
    56. 

  56.    void drawAngle(C Color &color      , Flt from, Flt to, C Vec &up, Bool fill=false, C VecI2 &resolution=VecI2(-1))C; // draw with angle ranges, this relies on active object matrix which can be set using 'SetMatrix' function
    57. 

  57.    void draw2    (C Color &color=WHITE,                              Bool fill=false,   Int    resolution=      -1 )C; // draw box based        , this relies on active object matrix which can be set using 'SetMatrix' function
    58. 

  58. 

  59.    Ball() {}
    60. 

  60.    Ball(Flt r, C Vec &pos=VecZero) {set(r, pos);}
    61. 

  61.    Ball(C Box      &box    );
    62. 

  62.    Ball(C OBox     &obox   );
    63. 

  63.    Ball(C Extent   &ext    );
    64. 

  64.    Ball(C Capsule  &capsule);
    65. 

  65.    Ball(C Shape    &shape  );
    66. 

  66.    Ball(C MeshBase &mesh   );
    67. 

  67. };
    68. 

  68. /******************************************************************************/
    69. 

  69. struct BallM // Ball Shape (mixed precision)
    70. 

  70. {
    71. 

  71.    Flt  r  ; // radius
    72. 

  72.    VecD pos; // center position
    73. 

  73. 

  74.    BallM& set(Flt r, C VecD &pos) {T.r=r; T.pos=pos; return T;}
    75. 

  75. 

  76.    BallM& extend(Flt e) {r+=e; return T;} // extend
    77. 

  77. 

  78.    BallM() {}
    79. 

  79.    BallM(Flt r, C VecD &pos=0) {set(r, pos);}
    80. 

  80. };
    81. 

  81. /******************************************************************************/
    82. 

  82. struct BallD // Ball Shape (double precision)
    83. 

  83. {
    84. 

  84.    Dbl  r  ; // radius
    85. 

  85.    VecD pos; // center position
    86. 

  86. 

  87.    BallD& set(Dbl r, C VecD &pos) {T.r=r; T.pos=pos; return T;}
    88. 

  88. 

  89.    BallD& extend(Dbl e) {r+=e; return T;} // extend
    90. 

  90. 

  91.    BallD() {}
    92. 

  92.    BallD(Dbl r, C VecD &pos=0) {set(r, pos);}
    93. 

  93. };
    94. 

  94. /******************************************************************************/
    95. 

  95. Ball Avg(C Ball &a, C Ball &b);
    96. 

  96. 

  97. // distance
    98. 

  98.        Flt Dist         (C Vec   &point, C Ball   &ball                ); // distance between point    and a ball
    99. 

  99.        Flt Dist         (C Edge  &edge , C Ball   &ball                ); // distance between edge     and a ball
    100. 

  100.        Flt Dist         (C Tri   &tri  , C Ball   &ball                ); // distance between triangle and a ball
    101. 

  101.        Flt Dist         (C Box   &box  , C Ball   &ball                ); // distance between box      and a ball
    102. 

  102.        Flt Dist         (C OBox  &obox , C Ball   &ball                ); // distance between box      and a ball
    103. 

  103.        Flt Dist         (C Ball  &a    , C Ball   &b                   ); // distance between ball     and a ball
    104. 

  104.        Flt DistBallPlane(C Ball  &ball , C Vec    &plane, C Vec &normal); // distance between ball     and a plane
    105. 

  105.        Dbl DistBallPlane(C Ball  &ball , C VecD   &plane, C Vec &normal); // distance between ball     and a plane
    106. 

  106.        Dbl DistBallPlane(C BallM &ball , C VecD   &plane, C Vec &normal); // distance between ball     and a plane
    107. 

  107. inline Flt Dist         (C Ball  &ball , C Plane  &plane               ) {return DistBallPlane(ball, plane.pos, plane.normal);} // distance between ball and a plane
    108. 

  108. inline Dbl Dist         (C Ball  &ball , C PlaneM &plane               ) {return DistBallPlane(ball, plane.pos, plane.normal);} // distance between ball and a plane
    109. 

  109. inline Dbl Dist         (C BallM &ball , C PlaneM &plane               ) {return DistBallPlane(ball, plane.pos, plane.normal);} // distance between ball and a plane
    110. 

  110. 

  111. // cuts
    112. 

  112. Bool Cuts(C Vec    &point, C Ball  &ball); // if point    cuts a ball
    113. 

  113. Bool Cuts(C VecD   &point, C Ball  &ball); // if point    cuts a ball
    114. 

  114. Bool Cuts(C VecD   &point, C BallM &ball); // if point    cuts a ball
    115. 

  115. Bool Cuts(C Edge   &edge , C Ball  &ball); // if edge     cuts a ball
    116. 

  116. Bool Cuts(C Tri    &tri  , C Ball  &ball); // if triangle cuts a ball
    117. 

  117. Bool Cuts(C Box    &box  , C Ball  &ball); // if box      cuts a ball
    118. 

  118. Bool Cuts(C OBox   &obox , C Ball  &ball); // if box      cuts a ball
    119. 

  119. Bool Cuts(C Extent &ext  , C Ball  &ball); // if extent   cuts a ball
    120. 

  120. Bool Cuts(C Ball   &a    , C Ball  &b   ); // if ball     cuts a ball
    121. 

  121. 

  122. Int CutsStrBall (C Vec & str_pos  , C Vec & str_dir, C Ball &ball, Vec *contact_a=null, Vec *contact_b=null); // if straight infinite line cuts a ball, return number of contacts, 'str_dir'=straight line direction (must be normalized)
    123. 

  123. Int CutsEdgeBall(C Vec &edge_start, C Vec &edge_end, C Ball &ball, Vec *contact_a=null, Vec *contact_b=null); // if edge                   cuts a ball, return number of contacts
    124. 

  124. 

  125. Bool Inside(C Box    &a, C Ball &b); // if 'a' is fully inside 'b'
    126. 

  126. Bool Inside(C Extent &a, C Ball &b); // if 'a' is fully inside 'b'
    127. 

  127. 

  128. // sweep
    129. 

  129. Bool SweepPointBall(C Vec  &point, C Vec  &move, C Ball  &ball , Flt *hit_frac=null, Vec  *hit_normal=null); // if moving point cuts through a static ball
    130. 

  130. Bool SweepPointBall(C VecD &point, C VecD &move, C BallD &ball , Dbl *hit_frac=null, VecD *hit_normal=null); // if moving point cuts through a static ball
    131. 

  131. 

  132. Bool SweepBallPoint(C Ball  &ball, C Vec  &move, C Vec   &point, Flt *hit_frac=null, Vec  *hit_normal=null); // if moving ball cuts through a static point
    133. 

  133. Bool SweepBallPoint(C BallD &ball, C VecD &move, C VecD  &point, Dbl *hit_frac=null, VecD *hit_normal=null); // if moving ball cuts through a static point
    134. 

  134. Bool SweepBallEdge (C Ball  &ball, C Vec  &move, C Edge  &edge , Flt *hit_frac=null, Vec  *hit_normal=null); // if moving ball cuts through a static edge
    135. 

  135. Bool SweepBallEdge (C BallD &ball, C VecD &move, C EdgeD &edge , Dbl *hit_frac=null, VecD *hit_normal=null); // if moving ball cuts through a static edge
    136. 

  136. Bool SweepBallBall (C Ball  &ball, C Vec  &move, C Ball  &ball2, Flt *hit_frac=null, Vec  *hit_normal=null); // if moving ball cuts through a static ball
    137. 

  137. Bool SweepBallBall (C BallD &ball, C VecD &move, C BallD &ball2, Dbl *hit_frac=null, VecD *hit_normal=null); // if moving ball cuts through a static ball
    138. 

  138. /******************************************************************************/
    139.