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

admin

. @" Q& k- E  ]1 p( ^% M
: {/ ]* S! s+ U0 m! [1 j# e2 f
【二次开发源码】一种基于点投影，获取投影原始点的方法
( g# N! q2 m  g: h; O% r, f3 |1 R7 q
1 _9 X+ C+ G4 u& v) P一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
' v+ m  ]+ g* P/ y然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
1 M" p! a9 q; ]  ^7 ~8 J! @  q

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   ! m1 N& o; w+ e* e% I
4. {
   
5.         double dotResult;
   8 h8 L, Y; C2 R. m
6.         double longDistance;
   ! c6 ?( D8 N" q2 m/ E- U
7.         double zDir[3] = { 0.0,0.0,1.0 };
   1 R# K, V% `2 g& r$ B! z; `
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    " \8 i. ^7 }4 s( W. g  L
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    0 O* {, Q, p" [# H0 V
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    " Y0 A, A% S5 n$ Y
16.                 return;
    
17.         }
    
18. 
    4 N( h" _& l2 t: Z$ N/ q
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    - i; c# f8 m/ O: a
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    2 \+ ?; |" X: a/ K4 P% S' s
23.         double cosAngle = fabs(dotResult);
    
24.        
    % R' _$ F+ G, p6 C% H2 k- T- r
25.         //斜边距离
    7 q/ h& a! [# X# [
26.         if (EQ_is_zero(cosAngle, MINTOL))
      r8 y9 p3 b. _$ W
27.         {
    , L+ ?( P. h+ C  I( o( b
28.                 longDistance = deltaProjectDistance;
    0 r0 l8 R) {9 N
29.         }
    
30.         else
    3 C" x5 M/ C8 {3 Y" H
31.         {
    & F" W% f0 ?; {* N
32.                 longDistance = deltaProjectDistance / cosAngle;
    % O2 y$ h, K9 N+ L3 c( ?2 r- c1 Y7 k
33.         }
    $ e2 i7 v$ |* Z+ H8 X  f
34.        
    0 r, u  W8 H- d
35.         //这里可能出现方向相反，我们需要进行一次判定
    * r) D; c7 c7 N! l/ I, K
36. 
    * j/ I3 A3 e6 a3 r
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    " d& m( f/ ~4 U- _1 q7 T' ]
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    $ S" Y- A  Y0 `8 [1 j
40. 
    3 Z, @7 n2 D1 u# M. E% {4 m; G
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    9 V  t: ~5 A. _# x6 }: E. j) \
44.         }
    9 s; i% \+ D' O! W  n, [
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    . A0 D8 {! g. i: L3 j
48. }

复制代码

6 O4 y; V- z. K3 H