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

admin

) v/ `& ]# W3 k7 z

【二次开发源码】一种基于点投影，获取投影原始点的方法
& n- _! k' g* u* I
) ^4 b8 W3 }2 d5 K一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

' M. v+ }1 ?( K' e- H

1. 
   0 X7 f5 Z$ ^% n3 r
2. //这里仅仅考虑Z轴方向
   5 m# j; V! {' F( r  s
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   / H" t, L9 C+ ~& c
5.         double dotResult;
   + z5 o. r& U8 l# {4 l# o6 ^6 B
6.         double longDistance;
   2 m1 N+ W1 R% P
7.         double zDir[3] = { 0.0,0.0,1.0 };
   . F9 q+ D; h: J& f
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    " M2 B4 `/ U5 z$ B2 p$ ?
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    $ W7 Q2 r" @; O
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    ; @  J) ~4 X) t8 U0 c% C/ p
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    7 G6 w, J/ I2 g! d* d6 v" g) p
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    ' @4 l. D4 C1 R% A6 F  j$ v
23.         double cosAngle = fabs(dotResult);
    8 S  D, v% j. @1 ~
24.        
    
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    7 p$ J) |) o6 u' s/ K
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    : i8 P, t" V  l; f
33.         }
    
34.        
    # {( B$ C: t/ e' `- R. _) U8 G2 G
35.         //这里可能出现方向相反，我们需要进行一次判定
    " t# W* K9 i, L+ k  |. V1 I
36. 
    5 c! O3 F) T. g" N
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    $ o% T; H/ q4 k9 X0 o
38. 
    4 o, p# r- v4 f, N; n4 m0 I
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    ( v( ]2 q5 m- M
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    / U5 ^/ e/ J, {7 R: K
42.         {
    9 ~) E4 q1 ?1 T  `
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    * l/ g/ }9 [* ]6 \* c
44.         }
    . o& I3 _9 g: D4 ^2 a5 Y/ {6 [
45. 
    7 e8 V' y9 `% j
46. 
    , u0 j" |& ?% e: _" i
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    ( \+ B  Z* j* z* a
48. }

复制代码

2 {* w" v8 e% ?4 H) v6 ?2 X0 B
% H, k! @3 N% P6 a+ [5 K! A+ L