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

admin

【二次开发源码】一种基于点投影，获取投影原始点的方法
' P; y  W/ [$ k  k$ ]- U2 z
8 N1 G# I! g" C) o* a0 k) j一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
- D( ~# p6 e9 O# T然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
1 O, f; P) D; U3 B0 e/ v! M
' X& _' L" J3 n( I6 p

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   ' x. `+ [9 H  j* S+ r/ Z
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   # u) O& b! H5 B4 `. A6 H0 Q0 K
7.         double zDir[3] = { 0.0,0.0,1.0 };
   9 O1 `' v2 i& t! j* Q( S' |8 `0 p
8.         //直线距离
   $ A6 a8 d- [6 V; V# q/ @; O5 Q9 I
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   : B2 C* `7 W+ i5 W
10. 
    9 x/ q* V, j% w6 T% h: Y# S
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    0 o# x) H' y- p. F: G% ?1 {( l+ A
14.         {
    ( ]' X1 B% b* s% G3 ~0 D
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    / F% _( H$ y2 j+ |. ^
16.                 return;
    # `/ e8 i! f2 s7 U7 }* w' V
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    . }. ]% a: h; J& ]: }
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    ' r- w! ?$ s% {7 E9 p0 l
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    8 K8 Q& v4 R: b' C) t
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    7 o; D6 g. k" m' L
27.         {
    
28.                 longDistance = deltaProjectDistance;
    $ ~# u( B, m: T7 y
29.         }
    $ v- O3 g5 m8 q5 q2 b9 K
30.         else
    
31.         {
    # H* v* O. H* S; I
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    5 _4 a" `  K" |& T. s
34.        
    - G. f5 v$ T! p6 k8 C* {
35.         //这里可能出现方向相反，我们需要进行一次判定
    / q$ W4 {9 s3 x0 {2 k
36. 
    % P# g8 u( e7 D) n! a& L# w# v
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
      [" _) N* u- |7 D
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    2 p' J' t+ W8 c' a" S5 M
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    + H- A9 `3 a# _& u
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    3 A& z$ q( r2 r1 s
44.         }
    
45. 
    
46. 
    2 H. L0 k/ W4 s7 T: s0 ?: V
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    ! v: I, s2 x7 {3 I4 a# Y
48. }

复制代码

) l3 t1 a/ l' _' K! W% r9 ]