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

admin

) {9 t$ ?$ b9 B3 a/ H% V

【二次开发源码】一种基于点投影，获取投影原始点的方法
6 Y$ X. y" D* ?- `
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
: Y) J7 S8 O" U& j$ y5 o9 q5 A然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   " n  V  F) O5 w) g$ w
4. {
   # V) m/ {1 W3 m5 ~5 ~6 a! N, s
5.         double dotResult;
   
6.         double longDistance;
   4 A: D/ n# G, h' i2 D) W
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   1 R- P+ R) F) W5 A( E2 r
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    5 i; g% M# s5 f5 v, A. ?
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    - e* w: H$ s- Y0 [* v" d
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    - v7 E: z* U* {. `& w4 y: g/ d$ a
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    7 R8 `  @& q  j& o$ F
16.                 return;
    % t+ ~6 b: d/ e; w% y/ H5 b2 h- W2 P
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    " R1 M0 X$ k' p4 T2 E- h
20.         //faceDir 可能反向
    0 L; x" M9 A6 i  W7 n$ J
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    ( a, g. {" n2 ]3 M0 q
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    * d) N4 g3 }1 `4 g. q
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    ( j! b3 {) v, r$ O" Q" u
30.         else
    & I/ V1 S  \  O4 n7 j
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    3 _6 H0 ^8 u% s
35.         //这里可能出现方向相反，我们需要进行一次判定
    ) I3 F) X2 \9 n1 c6 ?
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    $ z% _- M! Z+ Q# }. r
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    ' i# f6 [, R# e5 R/ |7 E5 @
42.         {
    $ o, }* _0 b1 C: {1 X& {3 y
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    # x4 ^1 _2 U. m; ~) H
44.         }
    
45. 
    
46. 
    0 b( ^$ \- F/ l) f7 ~7 t
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

0 D+ S& H8 S+ Q2 w( q; h8 I3 J& W8 b* A) r
2 k% \4 U& t) ]0 p; n, {