【二次开发源码】一种基于点投影，获取投影原始点的方法

admin

; j$ Z, r) s$ F3 e, t* _
' @5 |; g1 l( d/ Z
. |" s1 r- G% ]+ A& X5 L  I8 p【二次开发源码】一种基于点投影，获取投影原始点的方法
$ M. n2 V8 J% @, R) ^7 a
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
* p& y6 k  s: U7 d然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
( Q2 A& F& j6 q: r

1. 
   9 j' }& F9 e& \
2. //这里仅仅考虑Z轴方向
   & ?/ t. P6 F% Q" B& X
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   ) B7 G/ W; F9 O
5.         double dotResult;
   & t5 }0 @% t, W2 O+ G# H6 K
6.         double longDistance;
   6 B9 Q- I2 B" x# Y% A9 P3 e
7.         double zDir[3] = { 0.0,0.0,1.0 };
   3 L8 s0 Y5 E, G
8.         //直线距离
   / a) e) B+ g& N/ @* u
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    , N5 [, R* t$ r$ w
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    4 F) f/ c& a( A" f9 E4 W
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    : {2 M3 [7 `+ f$ O$ D7 g. l+ T
17.         }
    8 R! e& V# _) r# Q) d; a; d
18. 
      F- Z" z1 D6 p* P
19.         //计算夹角，通过单位矢量
    4 y+ k* [8 B# Z5 w: m! w
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    & K) W" D7 e' ~. Y/ D
23.         double cosAngle = fabs(dotResult);
    
24.        
    % u1 q. e& S& j% B
25.         //斜边距离
    9 B% l2 X8 Y9 @
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    : D6 e! {! i" C
29.         }
    
30.         else
    ' Y6 g. Z/ h2 H0 [
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
      T# z! V4 ~/ c: l+ {
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    ! y) u9 A( Y) {9 i
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    4 l7 @9 S% E9 Y! V1 D: q8 `7 U- e0 y
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    1 W0 O& t* c9 Y# c" C
44.         }
    
45. 
    / h1 A+ A# b4 O
46. 
    * N" k8 e' O- B) r
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

* k1 J) H1 }* i0 G8 B/ m