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

admin

; E, n7 s# D) r' a) v/ D
/ t9 p& w0 u6 v" h& g
【二次开发源码】一种基于点投影，获取投影原始点的方法

: t4 t) ^3 u( L0 E! R* P/ j一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
* S. _" }+ ~$ ~$ i$ ~然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   % [3 |; ~  p; D; C: b! c& G9 E
2. //这里仅仅考虑Z轴方向
   
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 };
   & E; E# x+ t" F, P
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    ' Y" o4 C$ L4 a* c
12. 
    ) s% f/ |( i$ J4 {1 @
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    , N" J* O$ K- Z2 e) X1 G, O* c! t
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    ) b; U# h0 N9 F: O9 g
17.         }
    - z9 V% R  x$ I  f4 d- o6 H( U8 G! p
18. 
    
19.         //计算夹角，通过单位矢量
    " F9 `8 O7 |# e, n! O/ q) ~& u
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    6 X5 O7 u! T( _, O0 A4 k6 h% ~) V
23.         double cosAngle = fabs(dotResult);
    
24.        
    4 j) b8 R  G6 R/ E
25.         //斜边距离
    / ~0 z" |$ R- S; [
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    0 k9 U5 P7 L; j' t. _
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
      S; l2 C+ z0 ^( a
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    ) n. `8 U4 p- [$ m* H
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    3 d) A9 d- I/ g4 M8 |8 ^1 i
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    2 G  L3 O9 D( D0 ~, N2 ?# t
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    5 f; i9 R2 g* F
44.         }
    - Z% T/ Y2 C- N
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    $ X7 R- y& l  y9 ]4 U* O
48. }

复制代码