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

admin

. h9 J8 W6 c8 ~8 U9 ?
! @0 e) ?! N& x! W
【二次开发源码】一种基于点投影，获取投影原始点的方法

3 e& h* @7 l8 ]3 q- V. k1 c. y6 n% e- u一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
! }8 r9 y# L9 \3 Y/ U# ^# \- O" Q, D然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
1 i% J% @! Z4 X
& B  m4 f+ W+ _, f- l

1. 
   
2. //这里仅仅考虑Z轴方向
   " _0 [/ U* t7 D( ?3 X# v/ e
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.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    # w. H# u  d5 Y7 |8 U; H7 t: x
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
    
18. 
    7 s, ^5 y' i& }
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    6 b0 e( }/ l2 e3 M! d
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    1 C1 o+ t/ Z2 O4 v  O- w6 z
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    9 `7 k+ E. t3 x  x
24.        
    8 j! E2 ^  x( g0 `( M
25.         //斜边距离
    5 V: ~( J" M" e9 E
26.         if (EQ_is_zero(cosAngle, MINTOL))
    ; }  J8 Z; s$ q8 g6 ]
27.         {
    ' {1 u2 l% C) g5 {1 O0 {6 {  C7 }
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    ) G8 \% l4 y# Y5 J& G" M5 M1 k
31.         {
      Z* _" f! j1 ^6 R/ E, f
32.                 longDistance = deltaProjectDistance / cosAngle;
    : u  h+ S" a6 f# s: j7 W" o0 O
33.         }
    
34.        
    ! L! k: L  K$ a$ d& v8 q' u  Y
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    . b( r0 Z6 E+ J- g8 v; o
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    * R6 S; U4 l  H6 R$ W+ U9 y/ z- z
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    / `8 g. ]6 w* `( G6 h5 H% K( D- X* D. F# R
42.         {
      A  h$ \% P5 `! u. _% u
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    ; \* @  w1 K9 {9 i# J
44.         }
    & ]' P; }; G- D2 d9 x7 S
45. 
    : ]1 ?: q% i) R# b- c
46. 
    8 u: i+ O% @6 n/ L* H
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

5 W# R9 f4 R6 i! c8 M' h
. r) s7 E. m8 f9 V+ M% b! F