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

admin

! k! e+ y0 P% D4 ^, D4 a【二次开发源码】一种基于点投影，获取投影原始点的方法

& k; y" h; H4 t; ~一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

& I7 q3 v& l- S7 ~# {- S6 Q5 e

1. 
   4 g# g3 d" o  I
2. //这里仅仅考虑Z轴方向
   9 ~- `$ D! b; V* G8 x+ l
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   ) j3 I4 r* L& J9 z$ L6 q
4. {
   
5.         double dotResult;
   & Z0 B, Q. J2 y# M
6.         double longDistance;
     _9 x! S$ {2 g
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    ; W- x3 P4 m* Z( J% r; R( x( r
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    / ]; H% F+ o) W1 j2 |5 l
12. 
      Z: Y1 s- T) @' U
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    
17.         }
    & m6 e( t: g1 e+ x% P
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    - a6 z# ]6 ?) K. j. W9 M
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    6 R, X/ I# X( x% Y2 O6 C5 v
23.         double cosAngle = fabs(dotResult);
    
24.        
    $ z6 |: \9 }# I' \& r+ M5 y
25.         //斜边距离
      U6 W0 X# r" N4 Y. m( G3 C3 {. q
26.         if (EQ_is_zero(cosAngle, MINTOL))
    9 q# n7 V; {% Q4 z, e
27.         {
    
28.                 longDistance = deltaProjectDistance;
      l8 _2 V# m6 X6 `4 V
29.         }
    
30.         else
    
31.         {
    7 M$ H( ?% {8 ?
32.                 longDistance = deltaProjectDistance / cosAngle;
    ' R2 n2 s# \! s! Y
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    ) z. O; U5 f" l
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    4 c5 {; x" m* e- b+ |+ z! S0 \
40. 
    / }* {9 s# W* E6 m$ [% T1 Y
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    - I3 w* M( R: d9 }2 ~8 A) _5 k
42.         {
    ( H  c! Q7 B2 n0 q  n1 z
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    
45. 
    
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

6 a# w) L5 o% ~