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

admin

8 g2 e3 r4 z' N4 j7 G' r$ U) q
% Q! u- B6 g& b1 V. w7 W
【二次开发源码】一种基于点投影，获取投影原始点的方法

4 G& j8 `# y4 b6 o1 F一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
: y0 A! E" c1 B然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   ' i( V) m) C& v5 {
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   - \; v( {1 h+ P9 b4 T) V/ E
5.         double dotResult;
   
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   - q! ^6 ]/ w( R
8.         //直线距离
   - w2 t1 ~8 F. z7 s! S
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    ) W/ ~" L/ M  }  {2 g* S& i% l
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    4 O( y& a1 _5 O5 [
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    ( K7 L3 ^2 H! [% t5 e
17.         }
    ! r. b, \2 o! r: p( B7 n! P5 B& |
18. 
    
19.         //计算夹角，通过单位矢量
    1 Z* [1 D; F3 s& X/ W: |3 @
20.         //faceDir 可能反向
    - ~- _( |) h# l6 N1 w7 _
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    ! F, s0 s3 G  v; c, l/ B2 h
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    3 _9 x4 E, U1 \$ k1 \5 @3 D
23.         double cosAngle = fabs(dotResult);
    , `# t# A! c8 P2 K
24.        
    
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    3 e$ X6 v$ B% {+ l
27.         {
    ' \7 ]# k' ^) O0 @7 y+ @. j
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    
31.         {
    1 k: c9 M- B& f
32.                 longDistance = deltaProjectDistance / cosAngle;
    * z9 x/ P. a+ x+ ~+ F
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    1 y8 v4 l% \% l; ?
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    4 M3 [+ Y/ o* h. Q
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    $ B+ o+ J1 I& x, v
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    0 p4 S; p# o+ C# x: G0 Z6 E
45. 
    
46. 
    3 q7 S2 H0 x- h7 Q8 e: Z/ h7 `
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码