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

admin

【二次开发源码】一种基于点投影，获取投影原始点的方法
7 d- r) m& r. b: V
一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
, W" V8 R8 P0 q. x% x然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
6 Z% J% r1 ~% @/ m- f) g" L) r
6 r- \+ ]% P. M' H

1. 
   : W$ I0 Q/ J& X, v+ O8 Y( v
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   6 X& _. S% N! j$ K% p# U
4. {
   - [! B( Z% L6 O5 w7 q
5.         double dotResult;
   
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    0 t5 e' H  A* |  t
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    5 U, n3 }2 _. B2 D0 h
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    8 B0 a; k, u2 @2 k8 D* J" Z
14.         {
      i% f4 y- e. J. U/ `
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    / V  ~: Z. C5 S# Y1 q
16.                 return;
    
17.         }
    9 F2 c5 L" G5 }1 ?4 g8 T- `
18. 
    ! M& s8 W; ^& L8 ~( T
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    ; K5 l& J5 j9 e6 J& _( E
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    ; @3 ^. r3 \8 R7 W
24.        
    
25.         //斜边距离
    5 G/ l# p/ f- u  P) _( B
26.         if (EQ_is_zero(cosAngle, MINTOL))
    $ F7 ^; u0 ?+ H8 S
27.         {
    ' ?6 b5 {8 N7 D  o5 W' L# K& x* ^1 G
28.                 longDistance = deltaProjectDistance;
    
29.         }
    1 o% ?- g2 E4 \
30.         else
    & j4 Q* K1 b! t8 z# t* B% N
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    : o$ M6 }! _+ ?3 o6 f
33.         }
    3 m& Y0 N; d0 d( m* o% l* Q
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    6 d% U9 j; ?" s/ [( e' P0 }$ M
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    5 G( q5 Q1 y& X; Q
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    0 [# z% v1 ]7 ^  n9 D" ]
45. 
    
46. 
    3 c' z5 G( W3 k: s7 j& G+ {: j
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    1 g/ Q! e& z( a% H
48. }

复制代码