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

admin

& e) Z8 n7 S3 m2 ~

【二次开发源码】一种基于点投影，获取投影原始点的方法
1 v2 W$ l# E& x1 H% }: `; u& U
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
2 W# @8 j0 n4 [" p- `3 [0 R; }然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   4 N" w, U0 c! p& x
2. //这里仅仅考虑Z轴方向
   ' a4 Z$ Q2 T, J7 O7 K0 a5 Z* h
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   9 w# Y4 o$ q/ n6 b& A7 u
5.         double dotResult;
     I5 ~5 f* n+ u) _1 m) F0 |8 {" R
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    & ]& G5 n1 a; q0 c; m
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    3 J+ V% H# n4 {' o1 l4 t
16.                 return;
    & g) `* v' M% k. Y
17.         }
    
18. 
    4 e9 p4 }/ M( U) `. i5 i* X! I
19.         //计算夹角，通过单位矢量
    " X: i1 A0 ]. h: ~- _, j' l
20.         //faceDir 可能反向
    0 g: P  F& k3 U6 j+ x5 q$ w9 i
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    ) s' f; @+ u2 s4 H$ m6 d' x. J9 z: I0 D
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    4 [' p+ @1 p; H. @/ m- }
23.         double cosAngle = fabs(dotResult);
    
24.        
    
25.         //斜边距离
    9 u# U# }8 j6 J8 `  W
26.         if (EQ_is_zero(cosAngle, MINTOL))
    $ `1 {" l& c9 c( X+ P% w
27.         {
    
28.                 longDistance = deltaProjectDistance;
    ( w& ]0 e2 R$ i( ^+ X
29.         }
    
30.         else
    , r+ J) u, {$ m* I; K# q+ N! C5 S4 o' W
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    * j9 [& o7 |; ~3 W
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
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);
    
44.         }
    
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

$ X' {- N" E& z! u* F. C8 Y4 ]
6 ^9 h; ~6 o4 I  b) k8 H5 D+ c