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

admin

8 q2 ]( i( I0 V, N1 R6 E. z) m6 M

- x& I: f( A# @& V, N% p5 k* l【二次开发源码】一种基于点投影，获取投影原始点的方法

. D1 z) Y- \! }! D0 a8 j一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
3 O& C3 I6 Z0 o' K+ w" T0 ~. a% L2 z然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
) p: u8 @7 r: z! y
* @  {" m! V. C3 E

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   ) N) Q1 ^/ T0 R  y4 P8 [; c% y
5.         double dotResult;
   
6.         double longDistance;
   / b6 M8 I& Q- `  ?
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   * u* z- m& Q- W8 V- G! i; e
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   ( k! l  [0 U+ _& _" K: D
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    + q* W' m  F9 N- ?
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    / y% y0 Y9 {# K  T6 v
17.         }
    " @$ |+ w5 c5 [3 y1 {( ^* C
18. 
    * W- s+ k) x9 ?, {- o
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    
24.        
    
25.         //斜边距离
    0 ]9 ~' f9 ?  Q- i$ d& b
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    2 ^" y6 A6 e4 v& ^* B/ q7 P
29.         }
    
30.         else
    # ~7 e2 O: b) O
31.         {
    & R3 F/ ?/ c% D, w
32.                 longDistance = deltaProjectDistance / cosAngle;
    $ ]. O0 x1 I5 p! ^
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    5 f0 v, J1 g0 L& w4 y
38. 
    ) h* T9 g7 H- j9 ~( Z
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    8 `4 V. q- K; I& Z" ]
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    6 y5 W8 p2 d: N1 W) ^
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    6 @' L7 ^: m0 {1 {9 v
44.         }
    
45. 
    7 g* v" @+ N7 G7 Z; g
46. 
    " P; D* ]7 W6 r- ]# ^0 R
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

' G, \" ^+ s6 e* B3 z2 R% x8 [8 U