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

admin

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

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

1. 
   $ X. v2 ~  w& b
2. //这里仅仅考虑Z轴方向
   7 T9 F+ e' Y. b5 t1 u
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   ' S( i2 o# k6 r3 A) Q
4. {
   
5.         double dotResult;
   - I/ c- @( h: X  E% o- b' @+ w1 O8 A
6.         double longDistance;
   4 a( F) l4 {( `$ z! E' W) {
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   4 w6 q9 H# q5 w0 ^! U
10. 
    9 p0 b8 I6 J0 y' G
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    % ^9 R' F  }, x" Y
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    ; I4 E9 v8 _8 \6 u1 I
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    3 ?0 L. T* {& n7 i3 s  [8 _# {4 O! ]. u$ {
16.                 return;
    - R& r' K( W+ H2 ]! Q
17.         }
    , |: N! ]; c6 O+ {, W# q
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    5 e6 n2 N6 L- a4 v* ]: @8 H
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    1 e8 |0 o9 j$ O& J2 P0 V
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    9 _- J5 r' F, l) k1 b
28.                 longDistance = deltaProjectDistance;
    $ r, Y: T9 `+ A9 T4 n
29.         }
    
30.         else
    * }* f1 u2 S) t
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    ) v# z& ~( i* m
33.         }
    
34.        
    ) P2 w5 x* T+ ~  Q# J" E
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    " u, q4 s* z, ^  p
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    , X2 R0 X+ X. R6 o  \1 r7 K: F
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    8 c) k5 F. s% u$ \
40. 
    ; w5 ]; g' H8 k* k# w1 ]3 K
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    5 X* i. m0 L; ]: r
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    ; t- x! y& U& x6 U1 Y1 @
44.         }
    
45. 
    8 [2 q/ ?9 C* t
46. 
    ( H' Q+ {7 O) e. n, i6 I( d% Q
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

$ w* K0 o( t" a  n/ N
; \, O% O+ I/ E8 ?" s8 _- y. ]