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

admin

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

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
: r' o: K  g7 U3 u2 ^& [# Z然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

1. 
   
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   ) J2 |* [9 {! p4 L- q& X3 y  x* d
4. {
   1 n' r; m! q# d. }
5.         double dotResult;
   
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   % J: c- J6 V" I, x" F- R5 I6 b* d. I& X
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    8 d1 X( u# W- S0 F" i' Q
12. 
    
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    
14.         {
    2 \8 W; q# y& c8 L. G
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    - ]2 H" p3 A5 n- W+ _
16.                 return;
    ' J4 g2 F& |  `7 T: i
17.         }
    9 W& f3 r6 Z% X2 e
18. 
    ! A( `7 F# W% t  P
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    : o4 x( N& C/ T# v) O3 }# E( [
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    * T; _6 J2 v1 Q9 H* @+ M
23.         double cosAngle = fabs(dotResult);
    2 m2 G2 {, n9 A0 H
24.        
    # x9 {7 m, b: u- z: x. s2 ~
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    
30.         else
    
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    
36. 
    
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    : c1 B' M/ _2 o9 H, O( t- t
38. 
    & Y+ W# ?; }# a
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    3 C4 _3 v* B& `0 H+ p8 ]8 G9 o0 @( j
40. 
    
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    / G" I; A+ f* H7 J' X
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    2 ^% d% L  z- P. J% ]: d" b$ b
44.         }
    & J, ]( _; I- I3 V
45. 
    3 {: z6 V* H6 H$ ~4 ^/ c, |% f
46. 
    
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    # r# H9 I; S- c& x: ?
48. }

复制代码

" N4 H3 q: ^8 G( F, D