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

admin

7 _: J0 W5 s4 n& C$ i
3 B* a- W# U. H: a  r【二次开发源码】一种基于点投影，获取投影原始点的方法
9 s* _/ W9 k) Q; A
$ X1 D- ~% S4 e9 s: L! v一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

4 M/ U3 o4 _& i0 g! a

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   2 O# g) u/ v) g" _
5.         double dotResult;
   
6.         double longDistance;
   $ v8 n% R5 V- ?; z0 k
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   + {8 M* d: ?' J& {
10. 
    4 |- U, G& K" f8 m
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    / u8 N$ H* @& F& D3 L& n6 |; r+ w
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    ! n( e4 C; |( s6 \0 u* s2 N
16.                 return;
    ! Z; s6 Z7 @9 {# [
17.         }
    ( V/ ^& `" D  F, N
18. 
    . ~( N# @! [$ o2 b3 w
19.         //计算夹角，通过单位矢量
    0 R2 D8 s, u( U
20.         //faceDir 可能反向
    + ^  Y* c$ H, N- v
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    
23.         double cosAngle = fabs(dotResult);
    1 i0 ~0 X( s# r. {& R
24.        
    
25.         //斜边距离
    6 C4 j  N. _+ K" I6 X
26.         if (EQ_is_zero(cosAngle, MINTOL))
    + s9 P2 m% i. ~4 _$ q1 D5 ^
27.         {
    
28.                 longDistance = deltaProjectDistance;
    ! G# ?# R3 t: p( ]
29.         }
    
30.         else
    
31.         {
    ' v) ~! t5 w4 t( Z* [
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    ! i- O  v( o0 D4 {( V" z
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    9 ]) X0 }+ u9 w+ A! ^  A
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
    
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    3 c: A5 ^$ A9 v" d3 i9 G
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    & Z" j; F6 _- Y9 I) S$ ?
42.         {
    % N& p0 [0 d2 a# G$ f" L" V+ r
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    4 T. O4 N$ [: z+ p
44.         }
    % u" Z" [1 n; T& {( D
45. 
    ! r' k# Y: L* z* K. `9 o$ \0 _
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

6 x* U% B% R# M# |  W: o' z