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

admin

0 o* n/ B  @  S0 f5 G. s; `% o2 }
3 j7 q: @, r1 E: T  Z3 S
: g- E7 }- H+ ]7 f, k- M, t【二次开发源码】一种基于点投影，获取投影原始点的方法
  ]' e. q0 K. H5 [  ]: ^3 S# S
) h1 s8 ^" h9 V( b. a0 U一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
7 u) w. S2 ?) M* {/ F- Y

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   
5.         double dotResult;
   9 u% T& c9 R' ~) p$ g
6.         double longDistance;
   ; r: p' l9 g4 _6 k7 u6 ]% L' D+ `
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   * P3 A  R0 h3 n7 q. C1 x
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    ( G6 d% k' n6 Y+ ]  U
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    6 Y; k. s: `! |3 Q3 d
16.                 return;
    ! x" v$ b# |" w4 ]
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    0 d; u% T2 d, F
23.         double cosAngle = fabs(dotResult);
    8 ~0 B" [9 |6 a) n, V
24.        
    
25.         //斜边距离
    1 y, {% F6 g6 y7 Q: b2 Y0 [8 A
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    0 m. u" |! n  o( W# O* n
28.                 longDistance = deltaProjectDistance;
    
29.         }
    ; K" x$ F3 G3 Y* v( [3 H& l; z
30.         else
    * I- D9 U1 g8 M4 J. v. W
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    0 b9 Y6 N! `! S5 `; s' p
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    & O9 f& L2 K! `( }
38. 
    & `! J: n" Y% R* d  f  d; M# a8 H- S
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    4 U9 _7 I% D2 z4 Z* s- x
40. 
    % [" h6 w; m' @
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    1 @: _8 T  g& \
42.         {
    0 W. K8 e7 q- F
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    3 c0 T, V9 [) ?" e; C/ [4 i
44.         }
    . k2 }8 V( A; g3 ?2 s) w/ b
45. 
    
46. 
    ' W5 c$ @4 k3 B! r- d4 V
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    % w& M7 t4 R3 m( C8 q8 r) j
48. }

复制代码

3 s- u7 B" p- k( B5 b/ x; h6 y( w