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

admin

* X$ N- F+ u# Y" ^. o
1 y% {0 Y* e5 x, M' A# V3 [
【二次开发源码】一种基于点投影，获取投影原始点的方法

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   0 U- S: x5 m% l/ _' k. j$ Y
2. //这里仅仅考虑Z轴方向
   # ^4 @3 x" h* B; S* N4 i1 k
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   / [% Y, G. b- u) N' w5 \0 [' f  t; x
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   - k1 [6 R. l* u! T* w1 ]: L
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   - H( e- v+ @( ~2 p* Z9 s6 A/ D
10. 
    . ?7 @9 d9 a0 a0 \* }
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    7 t0 r( l( E3 Z4 `) ?) P) E( {
12. 
    5 w1 i7 k9 ?, x5 i) q2 \& t
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    " b' i/ c4 P3 r9 p  I3 Z7 H5 L
16.                 return;
    ! W$ ~# X3 w1 b0 O) m+ i, y" T- r7 I
17.         }
    ! \3 @/ B9 N* f, R/ N
18. 
    3 B4 k* }" R6 B1 p+ M' i
19.         //计算夹角，通过单位矢量
    0 a  A6 g& j) R7 `' k
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    $ `# W: \/ P2 G1 N1 N  U( ]: A" S. h
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
      P  n& n! j& ?( I& n8 v
23.         double cosAngle = fabs(dotResult);
    - K4 R  Z# ?2 B( ^! l' W8 T
24.        
    
25.         //斜边距离
    * ]8 v  Z( f; J7 R4 b# Q
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    - A! ?  D* u9 `& n
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    4 f; x# m2 X/ \$ l1 f/ c4 \" T% Y
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    * S: m( Q3 N& g
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    ; d* }$ F% \' z; O  a0 Q
40. 
    ' D1 j" }/ b! y; O) `
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    ( t5 L8 g2 y8 h8 B2 c8 Z3 o
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    8 T1 ]' n% Y9 z  H' Q7 A
44.         }
    ! o( U5 A4 q  l+ D! G; V/ W' m
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

9 k5 O  |: I/ s: U. k7 r! _, c$ h
( X) O7 C) I4 u2 B6 H2 E% g