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

admin

, A' M+ a7 f  f

【二次开发源码】一种基于点投影，获取投影原始点的方法
! u- `- a4 I& O' d2 Y1 d
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
  Z0 y8 Q- o6 a& }+ G6 @+ s0 I
- x  s# Z: Y0 r* R% x2 f: u

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   1 W% ]( \0 |* x3 z- b( F/ Z" h
7.         double zDir[3] = { 0.0,0.0,1.0 };
   6 D0 q4 o2 ]# o, m& Y. h
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    7 Y$ r' a% V; G; J
12. 
    # K, K/ |; L. P
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    8 R% M6 }8 }* u3 M  t
14.         {
    1 k2 M8 e3 i! k3 j! k( B' i
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    ( X+ ^: Y6 ~& h) _& T9 N
16.                 return;
    
17.         }
    " Y+ @3 H& n" g" C( x+ A) h& h! n
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    % c2 h, W6 ]$ K' J1 M
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    + g) ^7 ]- M8 I
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    7 b7 P$ l" W" `" y1 u* J1 V
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    $ v, W8 _: w# N4 e6 e1 i
30.         else
    . q) _& F8 Q' ]/ h7 B
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    ' _; I$ f+ D! s! j
34.        
    + T6 S- ^, R. x, K, O
35.         //这里可能出现方向相反，我们需要进行一次判定
    / Q6 r* z9 g+ G5 C' _
36. 
    * ~; M+ K) q. [! y! Z! o
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.         {
    ; T4 ?9 t" }& `0 ~
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    * u7 A- `- f: H1 D; |$ r/ X$ t) N
44.         }
    % Q% L( D. B9 w) a3 X
45. 
    1 r1 C* m8 e# u( ]; F  A+ b7 s
46. 
    7 @% O4 g3 H7 S
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

& i2 E3 v" N3 w' ^