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

admin

& l* C9 R) k' }& Y
' k7 L  I9 r3 Y8 D% F! C9 Z+ Q【二次开发源码】一种基于点投影，获取投影原始点的方法

2 C) i1 p1 T  p8 C一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
- U3 ]  N: w* w% b) D9 w' R然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
  [! T( A) j$ {8 {4 K4 }- A
$ K- d7 N/ e& v& l) C

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   ( W/ x5 }; N4 W* R3 i5 k
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   5 S9 j2 D% S" ^* ?3 w
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   4 b9 s& m3 R) u/ ~. {" p9 @6 v
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    , i! b3 {+ m/ k- H
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    + F3 n6 h$ h2 _) @# B
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    . `6 _1 m3 L' T  D. }5 g
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    / x: M9 u6 m  W3 ~% z+ Z
23.         double cosAngle = fabs(dotResult);
    
24.        
    " b7 X- @- s6 [, f7 w
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    % Q% @3 O% C7 `. F
29.         }
    # B" P5 p: H8 G! ]
30.         else
    
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
      H* g% g' Z7 f/ I9 g4 w# U
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
      |' |+ U3 s6 A+ J. G' E( W
38. 
    # `/ B0 O$ ?& H& M" }! `
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    % q$ {. x- M  I( g7 Y
40. 
    4 B# n# V! ?8 u# L$ t
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    ' l" F2 T% W3 k, z( E5 ^+ o
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    4 z* j6 r6 _$ d5 i5 V6 O7 d
44.         }
    9 B; m  y- C, {7 w- B
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    6 f* C. n6 ]. M9 P9 L% ^5 j' H
48. }

复制代码

$ m$ M) ?9 B$ [% a: C4 A