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

admin

1 j! P; ~3 x; ^8 D( V2 X
4 ^8 u. u- R) e3 y% t【二次开发源码】一种基于点投影，获取投影原始点的方法

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

+ h1 t" V% N( `, A6 R. H0 `$ _

1. 
   - E# K% N% {6 p. x' y( q
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   , M6 E# k  j) d0 j  g, X
4. {
   1 R9 \1 k& N; `4 {3 H* ~; d
5.         double dotResult;
   
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   5 i) u& S# Q3 }2 S8 G
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    . E; }! P! K/ _  O  h; X: `3 a
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    ! b6 P& M3 @: [0 z: J% p; h$ c+ ~( G
14.         {
    % J& I$ Z8 {6 D$ L
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
    
18. 
    ) k( T8 J5 T- _  ]  t* B! z  E
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    / U3 V5 O2 B: |8 I2 z) n, Q
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    . y$ z+ i! `0 C/ L
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    
25.         //斜边距离
    ' ]  e' I9 N/ r
26.         if (EQ_is_zero(cosAngle, MINTOL))
    / y% l/ S1 Z/ u: A( j, P8 n! O) y
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    ' j- I) F- ]: ~7 G( z8 N/ u
30.         else
    4 q5 J7 q. I& X+ V- W
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    ) ]. F/ Z7 U0 F: ~$ ?8 C1 f6 e8 G
33.         }
    & T8 f1 y3 \, C
34.        
    3 ^% S7 y5 n5 E" f) y* y: t3 x, q
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    9 `; t! z/ }) R4 w- L+ R
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    $ |2 N2 R- s& e/ B% ?) [& L9 p8 d
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    6 k3 @- g, @" E7 j5 L1 c1 E
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    - i% H+ I  ?1 i" x9 Z/ {; m
44.         }
    2 o4 |5 M9 m: |: u) ]3 ^4 l
45. 
    
46. 
    ; z3 y  Q5 d0 c# m3 x/ J
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    8 Z% F" T0 }6 o
48. }

复制代码

7 f! n/ g6 \( L& Y) y3 [" m