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

admin

6 F7 L$ I$ o0 J! |* g# ~6 j& A

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

8 K. X2 K0 `& u  _/ j! b一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
2 F, R+ ?8 l0 e! p然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
/ e! D5 L+ q  S+ u/ Q
6 s& A& e' o& q0 N

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   2 A# O  c: H  a7 T
4. {
   
5.         double dotResult;
   
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   3 K0 u& Q2 v6 t' v0 @
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    0 h3 ]1 `  F1 M9 J2 \
16.                 return;
    . J) N) d% e. m' y
17.         }
    
18. 
    4 }: r3 V, E( _6 a+ o& p. C
19.         //计算夹角，通过单位矢量
    2 m& \) ]0 T* ]2 H8 G  w
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    ; z" p9 h2 Q* x' x" O0 i+ k* K/ S
23.         double cosAngle = fabs(dotResult);
    2 H( v3 d! q) R) w) d* A
24.        
    
25.         //斜边距离
    - l# ?' d$ p: x5 z. N9 h" [
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    / [# R0 X9 z& W6 \% K
28.                 longDistance = deltaProjectDistance;
    
29.         }
    & S# Z: d9 @7 V7 v
30.         else
    / Z- Y$ A3 n+ W% M
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    2 I& L: G8 T! V# y* }7 B
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    ; \' ]* D/ {5 a  Q
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    + u' e% `3 q( D
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    $ Q& M% C4 ]' h
48. }

复制代码