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

admin

+ Q; B; N+ t, G6 Q7 a
【二次开发源码】一种基于点投影，获取投影原始点的方法

8 h  b$ _4 @9 x8 b一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
5 N" `+ [: r, L" q6 D( M& ^( ~

1. 
   % \9 v; W2 @" D4 `# H
2. //这里仅仅考虑Z轴方向
   ! f3 N3 s( x$ n3 L7 `3 r$ e
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   
5.         double dotResult;
   ! R8 h9 ~" |+ ~
6.         double longDistance;
   + n+ _- D1 H' P
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   / Q7 A; O% k1 U, ]# a1 \+ m
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   + ^. l* N" G+ `+ x, b) Y! H, c
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    3 ]5 z$ Y" o$ T8 j: t4 Q8 K% V
14.         {
    ' `0 V# p5 x0 v, b* X- U& j
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    ) p0 q& @* _$ W" Q: }  w
16.                 return;
    
17.         }
    * X6 a0 T! a$ v: ~% P5 j2 E
18. 
    ' i9 P; V/ O9 {/ C- M- n1 E
19.         //计算夹角，通过单位矢量
    9 s/ U4 H( |6 B- y
20.         //faceDir 可能反向
    7 i0 i  }8 @1 Q/ A3 t- [- @) x
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    & X7 t. A& J" D( H4 t) l7 F9 L6 g
24.        
    
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    0 f7 `. f. O1 f5 P) P/ @# f
27.         {
    
28.                 longDistance = deltaProjectDistance;
    6 ^0 b7 D+ k3 u  g4 v- `. n+ F; Y# f2 e
29.         }
    
30.         else
    ' y  v0 R) M4 E$ G2 \
31.         {
    ( ]  n$ T  T3 @
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    3 C9 o* f- j, ?' ^$ c+ N# E
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    + s& K2 F# k( X. e$ ~6 M3 E% W5 m
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    2 B: r4 R- J& e& d
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    ) v3 i) C  C) y- O( U3 J7 }
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    . R6 @2 @3 v- y2 |
42.         {
    5 A% E1 z/ f3 U8 l) Z
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    
45. 
    - H5 f6 b% D  p3 A. e/ P
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    ) [0 P# X  n+ c( B+ E/ E
48. }

复制代码

; c6 _; |* d, O$ w