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

admin

5 U& ?: Z" j% O2 A
【二次开发源码】一种基于点投影，获取投影原始点的方法

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
- D9 W* ^4 T" M8 a( \2 Z; w8 K/ j
. n* S4 y4 p9 U6 P" g

1. 
   / E  }% v% x/ R. n+ y; O
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   0 t8 u" \4 J4 C) c# @; v
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   + N. y. p* {; _
7.         double zDir[3] = { 0.0,0.0,1.0 };
     N% Z6 W; W+ J" r% @9 E
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
      {8 t( S+ F5 j/ M9 U$ A
18. 
    
19.         //计算夹角，通过单位矢量
    6 j! j% M/ G, K1 T, H! z7 @8 R
20.         //faceDir 可能反向
    - n; Q& B3 E# _& }. U* L, b% W
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    - K  S: B- B& C4 \! j' g
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    : z9 F/ E* @; N" t
24.        
    
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    ' r  b, F1 n: Z- t3 ~7 V
27.         {
    + @  o$ E+ }* x
28.                 longDistance = deltaProjectDistance;
    
29.         }
    ) d1 T7 |: |  A( d4 W% P0 s
30.         else
    % Q- v' r# F4 t& Q8 I; P' Q3 [" V
31.         {
    , K) K: d$ ^; k2 U- n7 f
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    2 r2 U1 D9 S9 q5 I
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    9 I: m) b( h8 N0 A
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    , ]$ [5 W+ G' e, D0 F* E
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    7 N5 m/ c8 h  A% v1 c( T
42.         {
    # P: i: }0 ?( G. L  q' R! a/ A
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    8 {! T7 U* q/ P
45. 
    8 R8 M7 j! p% Y5 X8 A: G
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    " Y  ~4 h( |$ g0 a, _
48. }

复制代码