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

admin

3 O2 N2 l3 C9 }1 I8 P
2 x7 ~- v( O1 w% J# Y
【二次开发源码】一种基于点投影，获取投影原始点的方法
7 O8 L5 r  j8 @, d8 q. C
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
7 c1 y# w3 P# p# y; t* i

1. 
   
2. //这里仅仅考虑Z轴方向
   , W- o( ~4 C& t! l9 v! w
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   7 `1 Q* M( s/ s
5.         double dotResult;
   
6.         double longDistance;
   - P( A- i. j! X' ?* V7 ^0 d
7.         double zDir[3] = { 0.0,0.0,1.0 };
   * H2 r& u! C/ `# J* k" J: s( a) \5 N
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   & J" n" N  T+ P( n
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    ; E, Z1 u; e$ o7 N# E
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    1 I9 |. @5 N) T3 ?+ X! b" V( a& ?/ w
14.         {
    ' o7 K+ w. _5 q" z4 ^& G4 Q0 j
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    . [# D0 Q2 J) Q; I# U9 b& D
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    % ^& l$ Q7 A/ m3 r8 n' {1 C& f1 n
20.         //faceDir 可能反向
    $ y5 f6 Z4 P  L/ z8 \6 h+ k* f4 i. l
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    : S9 ^6 x! K4 z, R6 C
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    3 A3 M! ?) ?- z$ ?
27.         {
    5 g5 {3 q; o: H  o. n1 d" D
28.                 longDistance = deltaProjectDistance;
    
29.         }
    - m1 O: Z: e6 L- r; t
30.         else
    $ L, p* v, [9 G# h) i; r2 `
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    9 V7 o/ `+ g- \) ?/ a1 `8 t. u8 n: {
34.        
    + Z: q8 T/ f& x6 p4 T
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    3 w4 e+ }6 z/ p
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    & ~+ R$ t8 ?+ V
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    * D% [( X/ P- k. J' y
40. 
    % l6 D2 r$ m: a, C9 j6 K( ]% W
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    8 z' p  @7 ?# E) I, L7 ?) T" C
42.         {
    ! X+ a3 w& N+ @3 Q" m* M
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    
45. 
    
46. 
      K0 j( a  F; z& Z
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

! ^5 E' ?, \6 P( ?2 k& ^
0 y- a) _3 @( C; s