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

admin

' F/ v5 l2 ~, F* X0 Q* ~/ a

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

) A& z& ~8 \  J$ {一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
5 b  t! `* x; z- d  v然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
; j5 \0 X2 D! S" c! [2 `
4 I+ E0 s* p( V& n. n

1. 
   " ?% ?8 r5 |  c
2. //这里仅仅考虑Z轴方向
   7 P; `) J) Y6 R% X- b; g
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   . K5 |, C4 ^+ @9 a; U5 E
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   ; p/ [( q7 W5 Z) Y! M/ g4 P
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   ) W# b7 S7 s& `- ]( h
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    1 m* D) ?# n6 O" L. n5 i/ D
12. 
    ( ^9 |( G2 [9 w
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    " }$ r, g+ |4 j. G/ v, [
14.         {
    ; c( i0 {; N& o$ I+ N/ L' c8 m
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    4 a5 q/ ?' P2 c8 d; f
23.         double cosAngle = fabs(dotResult);
    2 d: I4 O' B' ^/ q; `7 q, [3 k' O
24.        
    # d$ r* K9 X5 i4 t, G! T& \
25.         //斜边距离
    + I9 e" y4 `5 P( r
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    ( S* a; _* H) o" z. i, I4 @
28.                 longDistance = deltaProjectDistance;
    ' g, \3 W0 l1 X2 c
29.         }
    
30.         else
    + M  i2 Q% i% n" h3 P
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    ) t2 |! A, l4 H9 u  ?- S! Z
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    % |' [7 f% v- O
38. 
    ' G0 e+ ^* {6 j4 ^# h8 H7 |
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
      D4 F+ S- H; p+ r& r! @/ i
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    9 N2 j7 ^% u; D. _0 Z% s% X7 |
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

( O) n' ~1 [+ B5 M& W" b