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

admin

: Y: d. m8 X! V
9 N% b9 w; _' z, T【二次开发源码】一种基于点投影，获取投影原始点的方法
1 }" q& N# Y+ u( f! C. a! z
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
, f& l$ [% g6 `- Q4 X! W2 x
4 `. l/ C+ O0 b8 i' C  m  k

1. 
   
2. //这里仅仅考虑Z轴方向
   + g: R5 b/ A+ W: p; Z
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
     {; s7 X) Y- K
5.         double dotResult;
   2 X* e  ?/ N$ v. ?4 g/ p
6.         double longDistance;
   + O8 {: m, j) m1 J. l
7.         double zDir[3] = { 0.0,0.0,1.0 };
   0 E' ?. F; @% T
8.         //直线距离
   . n! Q1 z' h' F& B
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   6 U  {2 ?& d3 b' u: V
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    2 ~" K: f; B% S. X7 U/ \
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    % Q0 M3 S! M  P  p; J
17.         }
    * G! H6 R/ t9 |% Q
18. 
    6 t* b4 S7 h% ~4 N( E+ J( R
19.         //计算夹角，通过单位矢量
    # ]* T8 t9 {. d  Y) a$ q4 ?
20.         //faceDir 可能反向
      |; X% U" U- N5 l+ y
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    - o* \+ ?* O; q$ }! h+ T& c& |
24.        
    ' ]+ H3 Q6 _& m7 D& ?5 n
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
      C  J1 [7 O: q
30.         else
    3 `$ d0 U( T2 V  z. s9 f8 D! I
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    ' F1 ?$ s# n! M  z" G
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    ; T/ a7 I# D! s; n# [
40. 
    ' k% {, R. J5 _  k
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    # }  |  v2 C+ N4 K
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    6 m' _$ ~. e2 k- A( H1 I  z, l
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    ' h! y- w6 L  M
48. }

复制代码