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

admin

' a: B3 @! I( i6 B4 l! M7 s  U
  A- Z. h/ S! `3 }【二次开发源码】一种基于点投影，获取投影原始点的方法

4 Z( x8 ?  [$ H% i一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
2 B4 k6 }4 a% G7 t8 I4 d3 z# S2 [然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
. w* ~/ {! K2 r
+ I: v% d- ?) X* h

1. 
   4 e6 s% Q. P9 V* F! B
2. //这里仅仅考虑Z轴方向
   ! J8 _/ u) s' u3 a& Z
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   6 r4 X; m" V4 T5 F8 ~( _
5.         double dotResult;
   
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   3 V3 I# L0 d  O
10. 
    4 \0 A! m8 n& S! L$ _& d2 F
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    2 X8 M* B$ f7 u. J' b  F
12. 
    5 W; J6 t# N0 r) e: v( B; N& ?/ D
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    : N1 Z. _3 w' R" P, a
14.         {
    6 a9 z% T! D; D% a$ Y3 u
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
    9 _" m: i- v8 }! k3 x$ I, V
18. 
    : O; o+ n& o4 |" s- U
19.         //计算夹角，通过单位矢量
    ! T- x+ J9 D) _8 _
20.         //faceDir 可能反向
    / O/ y0 h, _2 X. v
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    4 y  l* X1 Q, X" B/ k
23.         double cosAngle = fabs(dotResult);
    
24.        
    
25.         //斜边距离
    ! w2 Q# V5 ]' T
26.         if (EQ_is_zero(cosAngle, MINTOL))
    " T7 h1 ~4 K* D0 o. X
27.         {
    
28.                 longDistance = deltaProjectDistance;
    : G- R  n) S; h) y% ?# L, v6 d) a
29.         }
    , F+ {0 v3 m& t7 X/ O
30.         else
      ]0 B0 _3 k1 d/ ~2 N
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    # h0 }0 b2 N9 N6 e
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    6 {- [: D/ J0 q* P, F' w  d
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    % `# Z7 f( k6 D% K
42.         {
    + d. b: ^+ M5 H; [; M5 [
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    - K5 a2 v. f# q0 Z
44.         }
    
45. 
    2 y& l; u2 q: c& M4 Y; P
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    4 Q3 i8 ^4 n6 h2 I( V! U- C5 P" y
48. }

复制代码

0 a4 n% c% G8 J+ S- H8 V