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

admin

* P  Q' f. ^4 b2 z
【二次开发源码】一种基于点投影，获取投影原始点的方法

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   ' _3 F3 `% q6 z  n/ Q2 b
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   % D8 f0 a6 c# T3 E. F0 M" u
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   5 [% w1 ]# |* J' f
7.         double zDir[3] = { 0.0,0.0,1.0 };
   5 P" n3 G8 C9 ~6 k! j$ D
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)) //就是最高点 ，直接返回
    ) D$ q, _0 T4 X# G! v: K' W' D
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
      J/ n% ?* c3 q3 X$ ]
16.                 return;
    9 m/ j4 C; D3 R5 e5 J  Z
17.         }
    8 E6 u0 b8 i1 }! A6 S6 @
18. 
    ! P& B% p$ p4 k; E1 |
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    0 V/ N# x# {- e6 n) u$ l0 s3 q4 ]
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    
25.         //斜边距离
    # r/ C' i4 j) M
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    2 c! g" p( n4 t( R. A
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    ( h; Q1 [( F8 P4 k$ s7 [
31.         {
    1 h1 J) v" Q) {# {/ t+ g- b  g
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    - k" B2 p$ }6 A7 ~9 Y
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    / d1 p9 H( ?7 ~4 _5 o/ S% V' E
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    2 u. d) y' R! ~2 q
45. 
    9 v- p9 Y1 m/ _$ s, y/ m
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    ! d# z0 k1 L6 F" s6 Q' M
48. }

复制代码