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

admin

! L. Z& K9 G$ v# I
& X# b( `% r2 r5 e6 E4 ?' m
【二次开发源码】一种基于点投影，获取投影原始点的方法
! `" p$ ~0 P; j# L
- g! W0 U+ u; N# O4 V一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
( a( g- i" `% ?' [& y9 s' R" @+ L然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

+ E/ {# v7 t8 e' B7 C  D, D

1. 
   ! e0 y7 l% d# A' e- |1 e& p
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   
5.         double dotResult;
   . M  m2 ]/ A! H; K/ b# ~
6.         double longDistance;
   & h# D0 p# _, W& s: _2 q4 y' G
7.         double zDir[3] = { 0.0,0.0,1.0 };
   1 ?  \# i4 f/ D1 I
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    7 R# ^- s6 p# _) [3 E/ Y2 p
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    ' L( l1 J" J" N$ ^- Y4 e6 U
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    + n  x3 o; t# ]4 _5 w4 U
16.                 return;
    ; f9 H+ S7 ?" K9 ^/ G
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    4 ?4 D7 {$ R0 @2 l2 ^8 j
20.         //faceDir 可能反向
    . i+ F( L( ]0 K  z. V
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    # g/ h' V" T# q: b5 `6 m& S
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    & J) @  @8 z# H/ i
24.        
    ( Z2 _7 W5 A; H% \& _
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    * y- m5 s+ C. S" c0 h1 ?; Y5 k
27.         {
    + ^6 Z# p4 l, v3 Q' @# H
28.                 longDistance = deltaProjectDistance;
    % d& P! t& _) m7 A6 [
29.         }
    0 u: e" n* X6 v4 _, I: G
30.         else
    2 i+ U  ]7 _+ n+ K# o, B
31.         {
    4 m/ r& z1 j' A6 h2 y2 E9 w
32.                 longDistance = deltaProjectDistance / cosAngle;
    ! z( h% C: p+ k; b5 w
33.         }
    
34.        
    ) }8 x5 ^2 b6 V2 q& h, Y
35.         //这里可能出现方向相反，我们需要进行一次判定
    & e' |) `" a0 ~% O' W& i
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    6 m0 e: r1 [$ b# i2 Z2 Q
38. 
    & H% }  A; j4 u! ?! N
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    2 A9 \9 L! J1 D6 m5 P' \) n
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    8 x, t; Y$ E; g# E4 M
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    3 t# Q3 r, Z2 W
45. 
    
46. 
    6 H/ y" E1 I) Q
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码