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

admin

【二次开发源码】一种基于点投影，获取投影原始点的方法
( U+ F4 U3 N6 h6 L4 Z- G
/ U9 e: T5 F$ Z: Q6 b7 }, k& V一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
3 z+ a: Y0 r+ u7 T2 f! Z然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

& m  W+ Q3 t' V2 }

1. 
   
2. //这里仅仅考虑Z轴方向
   % J- D- W1 F; M  k! F
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   % E5 K+ H% r0 w' d% P6 ^6 A5 n! C
4. {
   - ~% D5 Q6 h+ b: U& `! O
5.         double dotResult;
   ! D7 f) ?5 b7 B# W
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   % b/ I. i2 y, T8 t$ p
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   * Q7 n# {% V0 G; S. k
10. 
    : V3 D  H% y! M1 o/ `# l4 i1 M. [
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    3 ?% o& Z* g$ g; v5 L8 G  ], \
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    ) g4 c' U7 W, [, m1 }. q7 n) a
16.                 return;
      v$ d" t, k5 X8 `
17.         }
    * p/ ]& D( ?2 Z
18. 
    
19.         //计算夹角，通过单位矢量
    ' m) |) d* b  Q" F  J) v
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    ; A4 F' m* j# }7 |
24.        
    * r- L& ?6 t$ R3 L5 {9 @7 R6 p
25.         //斜边距离
    + B% n5 h: r2 ?( O! F& n) i% M
26.         if (EQ_is_zero(cosAngle, MINTOL))
    5 ?" o! N, _5 z- `0 C- n$ B
27.         {
    9 ]2 X" E+ W4 T, ^/ k5 E
28.                 longDistance = deltaProjectDistance;
    * K8 j! i- [* n; x
29.         }
    
30.         else
    
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    9 |' v- `" n* B4 L. G0 c
35.         //这里可能出现方向相反，我们需要进行一次判定
    , w& q0 ?9 q+ R$ o6 d3 o
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    0 L( H6 }$ U/ [3 B. _3 T
38. 
    , U6 w1 C2 i7 B" e
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    $ [6 v7 W2 X2 `! C
40. 
    & [* w- ~' X) @
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    7 M1 u8 K: ]& N* P  R& A
44.         }
    * H5 J- I& K# @8 n+ D/ f( t3 h
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

; S% D& Y4 F" a2 B- k1 @2 @
8 p$ Q4 ]  {# \* Y# ^