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

admin

  I5 r% C/ j8 E5 m5 m# ?* s! K【二次开发源码】一种基于点投影，获取投影原始点的方法

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

; `& Y+ ]$ ?8 v+ c/ n3 T) w

1. 
   
2. //这里仅仅考虑Z轴方向
   1 r7 e' ?& q& ~0 k, E: R( _$ D  P
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   ! T! [- u& E' b. G0 K$ \' t- K
4. {
   % N4 g$ p- x7 G2 W- b" z
5.         double dotResult;
   " [8 N, p' w% ]7 k8 l+ G  z% t
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   ) w8 A8 w$ J0 I1 O0 G8 ^1 T) t
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   ) @/ i4 }- k4 f* }+ I! ^
10. 
    + o' ^$ S% v0 W) j1 U4 Z
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    3 h9 r  s9 D9 b. f# j- t, @
12. 
    9 q/ z! v) {9 Z  D  b1 V1 L
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    2 a! r: A( ?& M* g2 S, I! r
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    4 z; N. K' b7 g; J, [. }4 n
16.                 return;
    * o# z: m$ z5 G: a) v1 X
17.         }
    ' m4 v8 J5 x0 x' G' C) o
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    6 C) m6 H1 `' x8 K  t0 G$ e
23.         double cosAngle = fabs(dotResult);
    6 ~3 r6 ^5 ~/ \) I! \
24.        
    
25.         //斜边距离
    4 |% r  i- y3 u: Z! x4 Y! J/ B
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    ; \5 O+ {7 ?9 a# V. d4 `, s0 p
28.                 longDistance = deltaProjectDistance;
    9 J+ d6 m. u( K6 v* w5 I
29.         }
    
30.         else
    / y! {" Q0 p2 ]
31.         {
    1 \' H4 W. U$ I9 F
32.                 longDistance = deltaProjectDistance / cosAngle;
    . |* k( P+ L8 @8 |: Z' i
33.         }
    ' d" C/ ?& w/ T+ c! u' E
34.        
      h" e$ L& i1 `, L' k7 N
35.         //这里可能出现方向相反，我们需要进行一次判定
    ( ~" L1 P3 T, r8 n$ k; K7 h* i
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    7 U  C. L, {+ f1 Y, [
40. 
    & y% \8 @/ v+ d2 K1 z* Z
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    $ X3 Q: _  ^' _& J3 s
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    - S7 S$ V1 t2 m+ _
44.         }
    ! k- E- J  M3 |  O9 X1 _
45. 
      d1 B+ d  ~' }* k2 }  J
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

2 W2 C; L: \4 `5 b  V& l  n