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

admin

: N$ n( W7 m# q$ b! S0 x9 T【二次开发源码】一种基于点投影，获取投影原始点的方法
' F0 i7 M# \. j5 Z4 _" [
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
0 r8 U) u8 I2 @$ i
! `7 e! g# D; T3 @( c

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   ) S) |) G+ M! Z
4. {
   
5.         double dotResult;
   ' j$ B: G( p" O/ d2 ]0 O2 w
6.         double longDistance;
   $ @( t5 V8 S2 C* `$ j
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   6 a5 Z) O0 F' G. S  f. s" ]
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   ( h# ~9 n' m$ f% ?1 O% {( ?. P
10. 
    ! M& J+ T9 j) a5 A# _; E
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
      f1 ?. c& E; ~/ S' P/ \1 I
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    3 D5 D# ?$ C0 X4 ]
17.         }
    0 }/ l, x( F8 ]$ [0 `
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    * j8 v, o7 ?& l$ M
23.         double cosAngle = fabs(dotResult);
    0 T5 T+ ?3 I! p
24.        
    
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    3 A6 |; G# l- Q0 ?+ L( z
27.         {
    
28.                 longDistance = deltaProjectDistance;
    1 c4 |% f1 n1 j' |$ W- j: A: ~
29.         }
    
30.         else
    ( L  k7 A. k0 x  ]6 m* ~7 q9 s
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    % c' s" h5 V; x% P2 x
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.         {
    ' A4 }8 A+ r5 ~4 [4 b
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    $ m1 p# ]* A: W
44.         }
    + p! z& l! p. l5 h  v7 _& H6 X
45. 
    4 O$ g  [7 [6 O0 \- q) p7 k
46. 
    1 u$ u* A" E, _9 ~
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    . w' Q' A/ [5 a
48. }

复制代码

9 X6 n8 o: T7 G0 L- g! T