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

admin

- a# \) [0 r) G( n0 ~
【二次开发源码】一种基于点投影，获取投影原始点的方法
% K  N7 f4 E1 b  L# v+ c/ }2 I, ^8 e
- }9 k$ H& }  ]" W一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
& [% L/ [0 L% w! p  a8 P# \- [
4 {- ]. H0 F  L+ y) C% _

1. 
   
2. //这里仅仅考虑Z轴方向
   ; \- m4 w) ^2 h$ Y+ k# i
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
     n8 Q) p  y! j" w& V, W
5.         double dotResult;
   
6.         double longDistance;
   8 Q  b* g6 `7 G; x7 v( W5 U
7.         double zDir[3] = { 0.0,0.0,1.0 };
   6 {) ?: X0 D) B$ @6 j5 g7 D1 g
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   + Z& V8 I" N) }; l' ^( L  }
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    : \4 m  V3 x% d6 A- ?. A
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    & T$ q' [8 b* _( M: C1 l
16.                 return;
    8 B% P1 k. ]# Q
17.         }
    $ x/ K9 k" Z* {7 a
18. 
    ; o6 p+ r# K! k/ y
19.         //计算夹角，通过单位矢量
    2 ^) \: O, ^9 @' }! E: z
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    / w+ ?* K9 L+ P( L' u
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    ! {4 q/ G) W2 i8 `4 _" w, c2 B
24.        
    1 u  S# P! G3 I9 W! R/ ?$ Y! R
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    ) @# c+ {- X3 J4 G8 F2 _
27.         {
    9 T1 i$ H  F: H( t( W2 d( p
28.                 longDistance = deltaProjectDistance;
    7 d& t! C5 T" z* d/ S
29.         }
    
30.         else
    ! G& l; ?4 G( P* E/ s# a0 ~: a  `
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    5 D, V/ Q# F7 U( i2 a
35.         //这里可能出现方向相反，我们需要进行一次判定
    8 S' Z3 w, K9 k  m2 B' E( U
36. 
    8 b1 ^, q3 k* Y, e
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    4 |" m# j/ r, j  G- {, X
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    : H$ v) N( g# d9 h* k- C
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    & Y( p: I; ~- M4 m
45. 
    8 J5 S: l+ x" N: C
46. 
    ) e9 F" }" R" F* j# Y' k; i
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

' }+ ^/ g3 X! y) m6 M6 v