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

admin

7 F- E/ h& D& z' f

+ t. Z% m" ?. e+ o* Q【二次开发源码】一种基于点投影，获取投影原始点的方法
& c' r7 J! T0 t3 W7 `
" S5 o4 e0 \; l1 Y- v- p, j一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   & P6 z, G2 Q! g1 b4 v
4. {
   2 }2 i2 X% F& |
5.         double dotResult;
   
6.         double longDistance;
   , d) r! n7 ^; j; B% t
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   ( w. @9 _7 q7 }- C. b
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    * I! d. H/ k$ T/ X) Z
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    ! ~0 x7 t( \" Z* j- A' S$ O  `6 |
16.                 return;
    
17.         }
    0 D) u3 X5 V# a" d: ?7 r4 V
18. 
    9 \5 [$ x( Y% `  T! w
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    & b) N% }" H2 T( y/ W# \) B- F6 F
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
      d9 B" e) ]4 D4 c
23.         double cosAngle = fabs(dotResult);
    - {" a) R2 H8 y  p4 m
24.        
    2 T% [$ k3 m. D3 b7 u. v
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    8 G: T' P! o) G5 {
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    * S7 O; U' Q9 Z
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    . r5 G  C  c& K. j! S8 K
36. 
    ; v- P6 F( z, @4 o% Z; N! H6 X$ t
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    3 ~) P$ E  L" K6 w; V+ [# A8 q
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    . g( ?$ Y& S/ X" R
40. 
    # x' W, P3 V6 G9 N% ^
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    + s, u; n1 o# S( I3 U
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    
45. 
    
46. 
    ) l2 x, y6 v1 S) V8 w1 b
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

  Y- ~& C! e9 R
, T: B: P# d  `7 }* y  d