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

admin

8 F( r) _! P/ n+ t8 |3 z  w

- p8 K6 z4 o/ l4 k【二次开发源码】一种基于点投影，获取投影原始点的方法
3 x6 m2 y1 d' w+ D/ t. |0 Y3 l
# ^5 K5 l/ ]8 |一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
) P6 S4 \" M5 Q4 b然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
2 G' S& u. R2 E" H) `& V4 x- q

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   0 N% L0 k" p. Y0 @) Y  j% K
4. {
   
5.         double dotResult;
   5 g* P! U* I% Z$ S. M4 c
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   , U3 H0 ^" c0 T2 U
8.         //直线距离
   * _0 v- `' j6 E9 C( o
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    ; F, _# p8 A; R" M- ?; I
12. 
    9 d: {( v& L- H, {% E" j5 ?) Y
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    & e2 m' c& {$ F
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    & v3 W5 ~( l/ v& \, ^' f- P+ ^- w
16.                 return;
    1 M  v2 V* F5 q8 p2 |; |2 |2 ]
17.         }
    % d6 I# L4 p3 l8 ~5 n, b
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    . P# g5 q" b4 p9 q0 u
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    * q" S8 H$ s  l; O  u7 A' T
23.         double cosAngle = fabs(dotResult);
    
24.        
    ( w. B% T2 v& c* M
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    # ?0 a- {- w3 N* x
30.         else
    # B6 y* c% f2 g/ R# Q8 |
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    ) W" |0 `/ l& q! N, g
34.        
    + [9 ~4 N" G9 ^3 n
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    3 Y5 u. W7 t7 F3 J3 @
38. 
    . h9 ~' g9 Z; b, a+ ^
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    9 o( |* A, f" C$ t  J. U- A
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    3 ^' ]2 g( l9 i2 R8 {& |! l/ V
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    " N4 L6 R7 ?1 _; q  M8 S
44.         }
    $ H% m! F( f- F! `9 d/ W
45. 
    
46. 
    4 K7 Q6 r7 n& B4 O0 G: ]
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    , F# U" x3 P9 F  s
48. }

复制代码

  d. J3 |. _* `' v; @