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

admin

) f% A, A" y6 N) o, C

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

0 T! I. b. R9 V+ Z$ u7 D& b一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
" X) ]* W: I! h+ i- R然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
# e) B8 l: n2 M1 A" r

1. 
   ' j/ B. i, m% _; R6 z2 i
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   2 h! F- J4 @4 A9 ~5 F
4. {
   
5.         double dotResult;
   3 a  x6 q- Q4 L; F# Y" w3 z# ]
6.         double longDistance;
   ) i9 g; L2 T: j
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   ; o1 P" s/ B4 g# i( v
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    . }5 y# |1 \+ u
16.                 return;
    
17.         }
    7 o0 ~+ W# k1 ?7 Q
18. 
    
19.         //计算夹角，通过单位矢量
    1 f& a; J9 i& s& O
20.         //faceDir 可能反向
    - ^! s- ~' H* ?
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    / n) d1 p1 c* C$ x
23.         double cosAngle = fabs(dotResult);
    1 l% w# m& }) O* D$ o
24.        
    
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    ; E. g4 W: U$ }% r" ^/ O% R  l
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    8 c* Q7 \# z# }' C/ o
31.         {
    ! k1 d% J1 _. Y- Y2 x
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    : ]" `, p' P8 z
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    # o. n8 q4 d/ D' j0 C
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    $ z4 b2 L. x: ^' o' z2 c
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    : T2 p. W: \" g/ s8 g7 U0 A
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    * G6 c+ n" J9 D* i! m( L0 J
42.         {
    0 {, Q. Y' m: p! J6 x
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    # z* s" U; p. J/ Z% c
45. 
    # g+ w( j- H: e: I9 |
46. 
    & H4 c  {3 V  {7 b2 U+ R
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码