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

admin

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

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
) y: f$ D0 ~# y, ~5 K然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
8 I- G8 `0 I, m& P2 a1 Y; d$ O: N
0 q" W# H2 p; B# D7 Q- F; M

1. 
   9 v6 ]+ d1 D( f* w+ N: Z
2. //这里仅仅考虑Z轴方向
   ( {( w4 R* N% k0 z. V# c
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   
5.         double dotResult;
   0 a0 ]+ s6 P# O- V9 I! z1 M8 q
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   ! C. y. P  s- L/ x  l) }% T, _
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    3 W1 ], l% ~0 P  l
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    0 i6 g5 W# t) z
16.                 return;
    
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    % W3 @; \% |* V
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    : c$ S* m0 P8 N7 E* Z) \
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    : R! H, @8 h0 n/ y6 r2 j% v! D! }' v1 c
23.         double cosAngle = fabs(dotResult);
    + @6 a: P' `% E, M
24.        
    
25.         //斜边距离
    / A. k8 L& B2 n1 M' i% w
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    + M6 R2 [8 S9 ]$ l0 F* H- B
28.                 longDistance = deltaProjectDistance;
    % R5 }+ l6 E1 S2 A7 R
29.         }
    - j; F: |6 ?# \% l& g1 d# r2 g
30.         else
    ; t/ e3 t) H( Y
31.         {
    / n2 v4 W3 \2 ]) S) V9 o
32.                 longDistance = deltaProjectDistance / cosAngle;
    1 }' }- ~8 B- `7 T6 M
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    4 Q/ y* E& n# ~/ F/ g
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    . l4 W6 i( q! B
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    $ E$ R. O  o) n. f6 [! s' ^- \
44.         }
    4 J$ `% y5 l$ Z
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码