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

admin

7 {$ W, U- d" x- L# x0 F1 a

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

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
: }  U6 j# l" N' P然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

2 z4 d- {+ h5 z2 l' M5 e

1. 
   * z4 a/ L5 [7 ]) Z6 B1 B
2. //这里仅仅考虑Z轴方向
   - V' y/ x/ s, |* \) c
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   2 \& }0 f' d  X
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    ! u, r: M3 {+ s: {0 d' Q
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
      c. X; w' }, W* X5 o
12. 
    8 E- S, D4 o& P7 r9 ]
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    # H* J. m3 S' m1 K$ [' u
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
      P/ i0 U, q' ?; N. ~4 t
17.         }
    
18. 
    5 m1 j9 K" N+ N8 }$ D  T6 z
19.         //计算夹角，通过单位矢量
    8 c  U& S0 ~' K' Q8 ^
20.         //faceDir 可能反向
    : U. f" }; u* X: L! b
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    
25.         //斜边距离
    3 H4 V( E$ M% N) n; w4 H  C3 n1 `# O
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    1 J5 |3 ~# g) i' H" @, u- z
29.         }
    
30.         else
    
31.         {
    ( O( h  }* q" C" x) X5 h7 ]$ t1 V* \
32.                 longDistance = deltaProjectDistance / cosAngle;
    0 k& _3 \' e5 L1 F: Z6 E3 y8 h
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    ( {( u& P* ~- Z
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    9 N" G9 i6 g( K- }
38. 
    / X! D, U  k  F
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    . c7 q5 W; ]9 ]6 }1 ?' y" K/ v
40. 
    4 C2 [7 W5 |6 ~$ X- y) o. y
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
      G# n$ U2 Y; g
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    % T, _4 C+ n  g8 O" l- U
44.         }
    
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    9 o$ Q2 w% ?& s  A! V3 w
48. }

复制代码

# Q" r8 H1 [3 |2 `  b! r7 C: A) Z