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

admin

! d- t+ k3 q: Q- c, k$ H' K! w
  A+ w$ x3 b. e9 H【二次开发源码】一种基于点投影，获取投影原始点的方法
4 q& x4 C, t% u$ u; j
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

' P- v$ N$ d6 d3 F6 M

1. 
   : q4 T* P6 ~$ D) ^5 V0 o8 }3 v3 R
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
     v" f) K0 W: d
4. {
   & w2 e) V2 z% F5 H  p9 {( D0 z- H1 [" f. s
5.         double dotResult;
   ' ]' l+ @1 ^" C$ [& h1 j; N
6.         double longDistance;
     E$ u4 G- t( u
7.         double zDir[3] = { 0.0,0.0,1.0 };
   & j0 @9 D4 c3 X. ~
8.         //直线距离
     R4 R! A* Q5 L4 b, Z
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    : e3 v5 @2 Z' q
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    3 j- C: a  _6 K+ q
14.         {
    " B8 v; Y: M4 n4 \
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
    & J, M7 g2 ^% w9 H1 A9 S$ P1 E
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    $ N: S6 O! X; i  o+ e9 p
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    7 t6 _* {0 I& l! \; ~# B$ D
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    " \) K7 W# S0 M& I
24.        
    
25.         //斜边距离
    & P/ V8 k" J; I- }7 G/ E0 Z
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    1 q; p, d4 G& _6 S/ n6 a
29.         }
    
30.         else
    / s  H9 _. b" D, d7 I9 x' X6 R" n2 `
31.         {
    # R. Y% k, k+ z" E6 P! F5 Z, O. L
32.                 longDistance = deltaProjectDistance / cosAngle;
    3 f4 o" e4 J# O. H
33.         }
    , L' x" O) k! d* x
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    0 ~1 T) j& a+ J; z$ s6 B
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    3 l3 t3 g% _9 q
42.         {
    2 A5 N! @# H8 P& L
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    
45. 
    ! y- X$ F7 X! T4 z. M5 I7 ~' W! H
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

; Q: I1 l9 a, S5 w