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

admin

  }! v' a' V1 b

) g0 r  G: M7 O+ z' q$ E【二次开发源码】一种基于点投影，获取投影原始点的方法
# ~+ n( s' Z: b- ~6 C# h
- ~: n, p. S9 W8 [6 H& m一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
, p  w: @5 ^: s& y然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   ( a; W' T& [2 z! M- |  o
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   ( O/ H. G0 a0 A6 Y3 q2 M3 L
4. {
   
5.         double dotResult;
   : y7 T, q# D& K, U9 |/ _
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   / S9 p, U8 d6 U3 U1 u
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   * o. }+ T/ v' m# F' b
10. 
    2 }" z3 c% A) }+ X
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    5 W) t6 M$ T* W+ U& e* S8 e* _; B
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    / ~; M, O+ }8 f/ _' [# C
16.                 return;
    ( @, ~: N$ i) V2 u" E$ V
17.         }
    
18. 
    - Q, h+ A+ V$ E- @5 D
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    ! Q; J& L. v1 J. X! u) U
25.         //斜边距离
      `0 I- n' p; T
26.         if (EQ_is_zero(cosAngle, MINTOL))
    9 j! I+ I. R$ `0 g
27.         {
    
28.                 longDistance = deltaProjectDistance;
    8 O7 h, \4 ~; V
29.         }
    3 R4 w" {  y0 [: V! }
30.         else
    
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    3 G1 n6 O' [+ B1 a7 F; I5 W( e
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    - @- M+ u% m1 ?# W2 r8 E1 x& G
42.         {
    9 h3 f& d5 B8 m. [6 X/ [) P
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    " w( O2 p/ U* Y0 K# a2 W
44.         }
    
45. 
    - J; t) i$ i+ B& ^2 u# a
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    7 p/ x0 [  u3 J# U' R/ P( Z
48. }

复制代码

1 p1 `2 T% O! K2 Y0 @4 `