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

admin

: e6 D2 c3 g8 P  X/ Y& k【二次开发源码】一种基于点投影，获取投影原始点的方法
0 g8 y! p1 Q# J1 P$ [' y; m
) B4 U0 R! u8 I" F一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
- L8 S* r/ Y) ]1 }然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
) R( [1 M% Y2 ^. |( p

1. 
   3 c: @1 u  i' K1 ~5 S8 k5 G# W
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   
5.         double dotResult;
     [" L5 ?7 |& W) Q' s  d3 n
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   ; F: _5 u4 L" P- l$ d% l% J
10. 
    ' }# F* N. Q# n/ q* w8 i/ S7 M
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    ; e5 U& s# F7 u0 u; g& l# t! Q
16.                 return;
    + [. H. A2 i8 q% C% V
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    ) S4 l- p2 T! R5 \! r* I
20.         //faceDir 可能反向
    * v6 q$ m; V+ G& w+ J# r9 v4 j' ]
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    : L, ]7 l: C; i. l4 i! f
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    " d" K2 }  I& C8 g7 G/ U! x
23.         double cosAngle = fabs(dotResult);
    3 p# a- r* F. n# @
24.        
    " i2 Z+ C; }# k8 ?( N+ q) f
25.         //斜边距离
    # H' S! ~$ d9 o  \
26.         if (EQ_is_zero(cosAngle, MINTOL))
    + ?6 R7 {: s9 ?" L0 t
27.         {
    + q2 v$ a# Y: _! m1 O& @
28.                 longDistance = deltaProjectDistance;
    2 {9 a& }/ }* u+ ~1 w* B: t; F( s" G
29.         }
    ! `2 Q. r( G* z) }+ k
30.         else
    
31.         {
    . s. y+ P" v! g' d0 T( E1 \* c- d
32.                 longDistance = deltaProjectDistance / cosAngle;
    3 o6 Q. h3 F+ L( i6 w6 x$ n: R! Q* @
33.         }
    
34.        
    5 x: p9 p+ K# v; E9 ^4 c
35.         //这里可能出现方向相反，我们需要进行一次判定
    8 W6 l; m* I% n6 o+ Z* ?2 O/ m, x( ~
36. 
    , ~' Y0 Z7 @" k# K7 f8 p
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    / p' C) V; ]" t( n7 X
38. 
    2 o, w& U( y# Q% Z
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    % L0 I# I: d' [2 P& n9 I+ E0 V8 U
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    - N/ ?4 L) ~/ m* I/ G# D, t
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    / C4 G! e1 o8 p. q% |* F% l" t6 b
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    : s: l/ R* f6 R( c
48. }

复制代码