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

admin

( c* K! b9 {" ^/ T' v【二次开发源码】一种基于点投影，获取投影原始点的方法

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
) ?0 g' m! q$ O+ M5 L$ z) a然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   ; N* L6 g3 n$ j4 d$ F/ u
5.         double dotResult;
   
6.         double longDistance;
   , ]) |! B7 N- ^$ r3 x
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    ( u# w$ i! ^6 h5 u- {
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    
12. 
      Z: L7 G8 L' M( ?6 ]1 x6 \( H
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    , `4 Q& s5 S+ `# I* N. I
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    3 q8 ^/ C! v7 Z& I: v! |
16.                 return;
    
17.         }
    / J3 l: x+ n8 U2 B
18. 
    * W) h# n9 m) q3 Y, W
19.         //计算夹角，通过单位矢量
    $ [, m: }. x7 G" N3 ?/ X
20.         //faceDir 可能反向
    9 ], [7 ^* l4 {9 w6 \
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    4 V3 |6 y) m. z9 x& [* d
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    : o9 Y, O, J$ ?/ o, _% M
23.         double cosAngle = fabs(dotResult);
    4 J1 k3 m* R' Q8 q; {  F- g3 W. l, ?
24.        
    
25.         //斜边距离
    1 i) M$ P0 I; m- {. G1 s" j# u5 n
26.         if (EQ_is_zero(cosAngle, MINTOL))
    ( Z! @5 S# _: k& e7 f
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    
31.         {
    - E- K( Q8 u6 c- f( f$ d
32.                 longDistance = deltaProjectDistance / cosAngle;
    : i5 g* l9 x4 u" q) f/ `
33.         }
    + {% A! {# M" O
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    , d+ n- M# e; \' d3 x. E% i
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    6 L* {* t/ B4 F: T9 ^; x
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
      G- Y0 B& j, z$ O% {
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    " z" Y& V# S& q
44.         }
    
45. 
    & ^2 v0 v, B6 O. \5 [9 s  j
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    $ M% ]; u" X4 Z* O" T
48. }

复制代码

& v/ Q* o) ]& v