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

admin

2 i8 D( g5 L; _  X1 Y" u
* ~1 Y1 M) P6 _$ `3 a4 e3 [# \2 U
【二次开发源码】一种基于点投影，获取投影原始点的方法

5 @$ w1 p5 X5 S  t3 R一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
  _# _$ t% P- v* |) \0 C2 V9 [  ~
( L( |0 |/ v0 d) N3 ~

1. 
   
2. //这里仅仅考虑Z轴方向
   / q9 C  N5 [# ~9 \
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   - M4 s& g6 D# }8 H# u& N6 x
5.         double dotResult;
   + W! \+ z2 K) e0 Z6 x
6.         double longDistance;
   3 Y2 l# r2 L- W0 |2 C) T# H9 O
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   + z/ x" ?/ f9 X$ r9 K
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   0 U' d, ^/ E1 J# F
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    : U2 d4 y3 {3 B  c. ]7 a, i+ {
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    4 h" R; u) k+ T4 }  A% j
16.                 return;
    ( _6 v8 W/ Q  H' w+ v
17.         }
    % ^. Q! R# o) [
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    7 d$ ~4 v' e& k7 j& z
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    6 `2 I5 ]8 X" a6 V1 c5 Z
30.         else
    
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    * I6 ?# `, _) ?! z
33.         }
    5 v7 S' Q  u" ]1 U
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    6 U) v/ _+ ~2 o/ D
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    ( i( O9 Z8 D+ i3 \: ]
42.         {
    & X+ I: z5 _9 n7 L+ H& E  E: Y
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    4 U3 H- E4 S# y
45. 
    
46. 
    ' A6 U( K4 z7 e; ~
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码