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

admin

! v, V+ Q3 Y5 p- m# w$ g1 S
+ P% E) w# }" J" g1 v1 a
0 L- M- Y, E- Z$ h【二次开发源码】一种基于点投影，获取投影原始点的方法

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
' S5 d( W% x- k+ v: _$ Q然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

, v. s; P+ q' s$ m; A. H+ Y6 k

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
     |( \. Y7 \" ~
4. {
   2 ]1 B5 z: f" d& f( \! H  O/ U3 l: V
5.         double dotResult;
   ; B; x/ w% C: q' n  h6 J) J8 F1 p
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   - Z5 h0 K0 J1 f
8.         //直线距离
   2 {% ]& W; F3 Z" P
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    & O0 w/ E& y2 ^: j- d1 E
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    - D+ ~6 B- u) F( v
12. 
    " o: c& K* f& u' X
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    ! a( d8 u- o4 p0 A+ |/ S* Q6 x( c
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    ; ?7 L% k; c2 X/ ~! @
16.                 return;
    ; ^& r* M3 r# p* O4 D$ q+ Z
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    + }" N3 E0 n! o% x" p! A: R
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    5 E) M5 s9 k$ N. T
23.         double cosAngle = fabs(dotResult);
    
24.        
    7 D* p; n( [6 q
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
      x2 |; T; ]2 E6 r! r. j
27.         {
    1 l6 h' ]' I" |5 t* Q
28.                 longDistance = deltaProjectDistance;
    
29.         }
    " y9 [" y6 v8 s7 `* E
30.         else
    
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    ; o5 W% {) b; G7 v
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    # |* D; [( _) B# u
36. 
    : b* ^% B, R0 O1 T3 G
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    . p/ N- B7 U8 s; f; e$ B6 t  f# k
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    + f  C- B1 x# n! ?. r2 K5 l: ]
40. 
    ) |1 j' c: A( }8 L' x: u' X
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    6 y; g5 R2 W3 D7 [( y7 M" Z
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    3 ~' X6 E- \; ^$ B1 ^/ t
45. 
    ( K; h; t  H) m% i+ @
46. 
    ; ~& Y7 P7 O7 b# \5 A+ f
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码