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

admin

5 I6 [4 q0 H1 W' o( U【二次开发源码】一种基于点投影，获取投影原始点的方法

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
2 ~+ T% Y4 d  y9 V5 c& [然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
6 ?2 b. i- ?) K3 ~- ^1 _
) _* D, P2 |# v1 e1 d

1. 
   4 m8 ?0 p2 K. w9 O# p
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   0 m* L, I" D3 t- V) u- o
5.         double dotResult;
   & v1 t- F0 I2 V; t1 o- X
6.         double longDistance;
   ; y$ i+ G! I9 u- J1 g/ P
7.         double zDir[3] = { 0.0,0.0,1.0 };
   ; e* @5 f6 @1 o7 i0 y5 o5 z- r. u
8.         //直线距离
   5 T+ S& D5 B. V# W5 e% ^
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    , e7 k& Z3 @4 d+ _
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    1 V4 S8 V4 w- ^9 F( D/ U' L
12. 
    ! s& H: k% ^6 d3 Y# V0 o3 k
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    # B) ~% {) Z  r0 `5 A9 _
14.         {
    5 P! }2 \$ f  E1 C5 i
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
    , E0 k9 Z% u8 O  m: r0 b
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    0 B$ G: j7 F# y) [& _
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    0 h% r$ I9 |4 c4 N3 J
29.         }
    
30.         else
    $ R3 m3 K! z8 K  y3 C
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    1 S5 X& A% [; D2 |' }$ F# L1 g
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    ; p4 M4 i) r/ P3 M' ]
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    1 r5 W7 Y% M- A7 Y( l
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    
45. 
    " n1 `  |0 _8 B4 c' u* m2 T; A
46. 
    5 ~7 I2 t0 d4 _; ?4 J6 G6 f5 ^: I
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

# S! V9 y7 c" m4 k! [  ~
) E3 h9 F  w+ U$ r* [1 I