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

admin

; U0 X* g" P! s: g* N1 B

【二次开发源码】一种基于点投影，获取投影原始点的方法
6 }* B( ?1 v) T/ N
- W& V5 g$ [1 u" o! E' |3 D一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
  I! N0 g' A) u$ s' B  R, F然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量
! f1 ]  s! @2 ^0 ^, L# O4 n7 g

1. 
   8 D# N) R  Y1 c! F7 @( a& y
2. //这里仅仅考虑Z轴方向
   ' z$ u1 N5 g9 r: D% C4 O
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   7 {4 Q8 c5 X, C  e2 F$ o' T
4. {
   4 E2 I* E' X8 M- {
5.         double dotResult;
   
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   
10. 
    3 H+ l* v9 }% t* @& ~4 T
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    / a) V  R( Z6 B# Q6 t- E) f
12. 
    7 ?, C% W  @. ^7 L
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    " I  U3 |0 y3 t" \+ d$ n6 Q9 P
16.                 return;
    
17.         }
    
18. 
    
19.         //计算夹角，通过单位矢量
    1 `. L7 |: H7 \$ m4 i3 ^; e$ f
20.         //faceDir 可能反向
    $ ]. c+ r8 o( u$ A5 V( ~
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    3 |# G0 a: C! i" K/ b
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    3 _7 }1 G) I. w
23.         double cosAngle = fabs(dotResult);
    + q! S: ], s" t) z# W! G: m6 I
24.        
    
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    " Z0 P6 |/ S8 j7 e. U* K
28.                 longDistance = deltaProjectDistance;
    0 _5 v" x4 [, b4 r
29.         }
    - V. U6 o* j; f  t3 [9 |$ o
30.         else
    
31.         {
    + o! B. a! a1 ^4 G+ h4 ]
32.                 longDistance = deltaProjectDistance / cosAngle;
    , P) m& u$ q& p/ i& J/ ~
33.         }
    2 U3 H. P* C6 }. G
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    0 U6 |6 L0 p. j% }8 u
36. 
    $ a! l) E- q3 _  R; Q3 u
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    : ]# V/ \, V. P' y
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
      q% y* i0 f0 L$ V; N4 t- ~
40. 
    ' R" m% h" g/ F( f# P0 M$ A0 g0 N+ m
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    7 w) E( p3 h% c  V+ H
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    3 U- x5 M1 d4 ?8 G8 U7 Z( o
44.         }
    9 G' @4 [1 w5 V# R7 p
45. 
    + c. m2 Z( _1 W7 S: w* ~
46. 
    6 Z7 z& E: V: C" D: [
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    4 t% \7 M' F  o1 r7 r( p4 w8 l
48. }

复制代码

3 o: k, w. {! a0 E