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

admin

【二次开发源码】一种基于点投影，获取投影原始点的方法
! }- ^( v- c+ }1 B
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
' o; P0 Q+ J$ X; r7 t1 l. Q

1. 
   
2. //这里仅仅考虑Z轴方向
   5 @  d# {8 h! K
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   % c3 ]2 ]1 J( r  P) e3 m7 }
8.         //直线距离
   - i' R$ q" Z& G$ v
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
      S: o: W3 y7 p- A- {
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    + d6 p$ J& ^" T' n& e7 _
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
      W$ s8 j* w+ ?9 S
20.         //faceDir 可能反向
    * i3 P7 H9 ]) K2 ]( h+ u5 g# z
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    3 q0 j% m/ A! ?
24.        
    + T! K6 L6 G0 E; _: `$ F4 c) D
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    & S0 |$ N% W7 b( B' v' m( M, _9 ^2 r
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    " C7 w! L/ U/ o
31.         {
    9 E' R3 S. Y. }
32.                 longDistance = deltaProjectDistance / cosAngle;
    & E' Q* h$ @* _' j: U
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    4 ]+ X& L# Q4 f1 k0 x; Q
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    - _8 Y2 {; l( s! c" G. j" J
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    7 c& ^" |, M, X* K7 S4 W3 `- Z8 m/ w
44.         }
    ! M8 S% W9 |: R% T8 A
45. 
    
46. 
    ! U) S( M' r% w% P3 ^
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    + e6 _) ^  H( x5 i) {
48. }

复制代码