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

admin

  U/ _  |& A7 t3 C* s, \( ^
【二次开发源码】一种基于点投影，获取投影原始点的方法
4 p# o, U/ c" g& R6 }
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   $ `  L" Q% p# O0 `
2. //这里仅仅考虑Z轴方向
     P3 F7 y, E) J, P( J- X
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   ! y, ?# n9 v8 o2 I
5.         double dotResult;
   $ V) F  ^- F9 j$ t! j; Q- A
6.         double longDistance;
   " O8 @' r% @4 O8 R9 [. F
7.         double zDir[3] = { 0.0,0.0,1.0 };
   3 d' C7 \9 h" G# X. L- B- ]  q
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   + I1 J  G" r# {# ?" k  z
10. 
    0 \, [( D; _( h& Q6 H' ]1 k
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    7 F" L; W7 g9 b6 j& |, X% P
12. 
    4 F3 ?4 f6 }! C
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    5 J* Y- y$ a# M3 z, ~/ W+ a0 o
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    : N$ r; X* E+ y% j5 ?
16.                 return;
    5 r( k5 U, Y9 t+ v% L
17.         }
    
18. 
    0 s& t; u1 O6 `  b. p  \( K
19.         //计算夹角，通过单位矢量
    # N! Q2 ~  }8 B# u, f: B6 _
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    3 K! n8 @1 \) I7 N  K: p
23.         double cosAngle = fabs(dotResult);
    4 [' I. X2 O( @9 ~4 N
24.        
    
25.         //斜边距离
    8 }5 E# Y  Z) p! T
26.         if (EQ_is_zero(cosAngle, MINTOL))
    8 A$ C. k. M9 T  a: l# P4 \2 ]! u: t) `
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    5 w; I3 P/ m7 ]& C$ r
30.         else
    
31.         {
    & \, L# @( A* y. Z6 k& J3 V, A
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
      A5 G$ b5 B, `6 p8 I2 E. G1 I/ s$ U, E
34.        
    , m7 P* g. u" `, _& l4 X/ w  {
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    ; ~+ t7 _5 {7 P* j! h  Z
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    / S5 X2 ], k) V% s
40. 
    : q5 G8 F  ?* y3 P9 D
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    " ~1 J  ]0 i) ^; Z
42.         {
    % u; t: o; h6 c
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    $ I1 |+ u- G) J& M; a+ Y6 [/ w
44.         }
    ; s% V4 L+ e+ A6 H  Y* Z
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
      a& u- Q) `+ V0 @: q
48. }

复制代码