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

admin

8 X; H; m4 L* j. x: Q7 [
【二次开发源码】一种基于点投影，获取投影原始点的方法
9 L7 x8 r+ s3 {8 }, m
- l9 }/ Z& Y' ~5 |9 s0 |一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
+ }& d) Z9 A7 Z# |4 p5 d+ G! e+ W然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
$ j% H0 \+ g( l3 m/ q& ]& _: N
, J) L+ F2 g& h/ d& Z

1. 
   
2. //这里仅仅考虑Z轴方向
   , H9 x2 V! ~5 \* T) E1 ^
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   7 ]! ?6 J% i- D/ |) k
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   * i2 L+ L* f) h" K) Y4 b' o
7.         double zDir[3] = { 0.0,0.0,1.0 };
   6 U! j% G$ F: h7 u% r$ |" Y
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   ! e7 i0 [. C. I: g2 A
10. 
    " V0 `; [) Y3 O$ k# `! T. H- C
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    4 }3 L4 E. |* Y
14.         {
    # A5 h( z3 G+ y' x+ K' @- {& P
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
    
18. 
    % L0 E, p7 ~+ {) q4 V6 V% l
19.         //计算夹角，通过单位矢量
    % d1 i$ p5 T; z( L  M5 \
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    / ~, m! O) T2 }/ o: D" _- y7 O0 p7 b
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    3 W3 `( R* X5 A3 g0 J" w; l% ]5 a. O
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    5 i9 F- ]$ z$ m
27.         {
    - S5 N+ r% I8 v  [, _# y' z; }( R2 _
28.                 longDistance = deltaProjectDistance;
    
29.         }
    $ Z. s1 D- ~0 ^
30.         else
    
31.         {
    % j! `" C" [+ d8 m, N
32.                 longDistance = deltaProjectDistance / cosAngle;
    : c7 O9 }! C6 ^. `& h( E
33.         }
    
34.        
    # F/ s: Z/ O/ p6 G/ W
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    " B" y& A; t4 y9 ?7 l0 G, b, C9 p2 p
42.         {
    " c" @! V2 m( i% {
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    * I% ]0 n# `5 D/ Y: O
44.         }
    ' K& d# P5 i/ P
45. 
    5 D! z. w# _8 U  d# G# y% H! ^% ?
46. 
    ; `+ h8 y+ {# N' `8 I% U
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

* v1 g) v/ D3 T3 e