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

admin

. n7 }$ \8 \* e" ^# m

7 H" N. Q$ e  r: ~6 d【二次开发源码】一种基于点投影，获取投影原始点的方法

2 w# Z% y4 q! t# g一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
8 j+ ?9 T7 X+ H+ B  q3 P$ V) N$ o然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

  D* e% k$ a* B+ O. t- l7 a

1. 
   + R3 Z) q3 t, o- F6 q+ ^/ C+ c
2. //这里仅仅考虑Z轴方向
   ' h- T( D0 X, E8 m
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   : o6 l" `6 e( w4 z7 E
4. {
   
5.         double dotResult;
   1 ?( Y- E. d$ @
6.         double longDistance;
   . Y0 h/ Q" C1 ~1 x( K8 C: N
7.         double zDir[3] = { 0.0,0.0,1.0 };
   , K5 a8 @& W- {3 _, \4 e3 j9 o3 h
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   1 v, D; Y0 y' r* Y
10. 
    # ?9 o- ^+ @( R
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    - m& G! X" W8 r4 o
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    $ m" r, T2 D& i/ S1 ?6 {
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    3 T8 u: f2 M9 f# r( ~5 F3 [: }
16.                 return;
    
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    , a4 ]0 j% R- {
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    + @" Q( u9 M# E) m: `, q
24.        
    
25.         //斜边距离
    1 R* I7 R7 F$ V
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    $ y4 y% w& ^9 f- t
31.         {
    6 v5 i8 ~$ C, J6 @5 _3 F
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    1 u4 W" I5 i2 ?  y# [" v/ f) G
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    + g* v& O& ?# v4 S
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    , e% b/ a& \, V. @3 X4 \/ z
40. 
    : Y  k% E4 ~& i( R6 U
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    9 y8 P" T! M; D5 U. x( I! b7 q
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    $ N3 G, g2 }6 B  s
44.         }
    2 B7 P/ U$ f/ ^+ b" t7 I* `
45. 
    
46. 
    $ w0 [( |9 s5 {5 u1 e! w( k# \
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    8 C* B1 }# T# Q. w" u6 Q" r7 ^2 W+ J
48. }

复制代码

0 r; M6 |3 n# ]" V
4 R2 h: R# o6 Y( u6 u) {( O8 r