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

admin

& v: I5 K0 f2 L0 `' M2 u【二次开发源码】一种基于点投影，获取投影原始点的方法

9 i) l; q$ q  [4 U8 u; o9 I一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   . I8 k. U3 L. h- f- P
4. {
   % k1 |8 g* w) k; E1 t
5.         double dotResult;
   * _9 g+ B# c) T  x  R
6.         double longDistance;
   4 \; h. o  S; H1 `
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   ! I- C; J7 {# v# c- L/ Y7 b1 U
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   $ e% |" P9 X# D& |3 Y
10. 
    6 n) t/ \: i3 C5 d* k
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    ; [9 M9 T* O/ K  T
14.         {
    6 `( A" K+ m; I9 ~
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    2 ~, s5 k: |1 O5 Y
16.                 return;
    
17.         }
    ! U# Y' i' a  T: t% g( S. D- q
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    3 j# q3 ]- a% _# i+ I2 i
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    3 F7 _+ ]; R  W$ Y' ~! y
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    % [: t/ j# m$ D. ~- C
25.         //斜边距离
    / v. f5 P( w6 b
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    % e* C8 w3 r! |" e4 J
28.                 longDistance = deltaProjectDistance;
    / Z. o; m3 U& `
29.         }
    , I: n1 q2 R" d
30.         else
    9 H) Y/ ?  A) ?7 e
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    9 W. i& o" n( u. w+ h
33.         }
    
34.        
    " C! ^. V- n# V& Q4 N) x
35.         //这里可能出现方向相反，我们需要进行一次判定
    7 n# T) j8 \" O4 r. T
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
      O, F# r# n) m; n* s. m) x
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    1 M4 b) L* W2 v8 @( r5 P
42.         {
    " Z+ m/ A" G) c# [
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    / x* ?) H% e& x
44.         }
    
45. 
    " d* m  u9 I- o+ @; p- Z( F
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    0 M+ _) L. R$ b0 N$ E
48. }

复制代码

$ L6 s6 |5 j2 Q