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

admin

/ M, G! X5 D" u+ r6 m. w( T% ~【二次开发源码】一种基于点投影，获取投影原始点的方法

一直斜边和一个直边的向量，单位向量可以通过dot 获取 夹角
; L, {1 t! o) t/ ~/ D. D$ `/ u然后通过勾股定理，计算得到长边值，最后进行基于点的affine，即可获取斜边向量

9 S9 H* [) Y, Y7 s  a& k

1. 
   * ]0 ~0 f# C. r' X8 D
2. //这里仅仅考虑Z轴方向
   
3. void Get_Projection_OrignalPoint(double basePoint[3],double maxZValue,double projectOrignialUnitDir[3], double newOriginalPoint[3])
   
4. {
   
5.         double dotResult;
   5 k! j4 y' A0 V6 n( u2 I# N
6.         double longDistance;
   
7.         double zDir[3] = { 0.0,0.0,1.0 };
   ) U7 v2 X1 a& K8 ]. I- g
8.         //直线距离
   
9.         double deltaProjectDistance = fabs(maxZValue - basePoint[2]);
   $ N. Y# m9 t( ~3 b; b: k' q! k! d! R% ~
10. 
    
11.         Echo("斜度垂直直线距离:%.3f maxZValue:%.3f", deltaProjectDistance, maxZValue);
    * v; r5 ]; F  n; P% O3 p
12. 
    & o6 |$ f8 j0 \
13.         if ( EQ_is_eq(deltaProjectDistance,0.0,MINTOL)) //就是最高点 ，直接返回
    & y% |; {. j* m
14.         {
    
15.                 UF_VEC3_copy(basePoint, newOriginalPoint);
    
16.                 return;
    ( Y/ F, P2 _( |6 f: j
17.         }
    5 u* Y& _8 B  U# K3 L& f* q
18. 
    
19.         //计算夹角，通过单位矢量
    
20.         //faceDir 可能反向
    
21.         UF_VEC3_dot(projectOrignialUnitDir, zDir, &dotResult);
    
22.         // cos() faceDir.zDir = |FaceDir||ZDir|cos(angle)
    4 {- C& g# C# S$ C- P5 I# q
23.         double cosAngle = fabs(dotResult);
      u( ]$ j2 t: t$ m& f
24.        
    / t5 H  W! f" @: G2 w4 ]
25.         //斜边距离
    
26.         if (EQ_is_zero(cosAngle, MINTOL))
    
27.         {
    
28.                 longDistance = deltaProjectDistance;
    
29.         }
    : a( |0 G# n: ~7 S
30.         else
    
31.         {
    
32.                 longDistance = deltaProjectDistance / cosAngle;
    
33.         }
    , }/ Y5 s8 l6 C7 {
34.        
    
35.         //这里可能出现方向相反，我们需要进行一次判定
    % K8 I- u0 L) `
36. 
    6 p, F4 Q& C' R; G4 u
37.         UF_VEC3_affine_comb(basePoint, longDistance, projectOrignialUnitDir, newOriginalPoint);
    
38. 
      X" t! B5 g- B9 z" _
39.         Echo("maxZValue: %f ,newOriginalPoint[2]:%.3f", maxZValue, newOriginalPoint[2]);
    
40. 
    ) z8 J* C: O8 k" ~+ D
41.         if (!EQ_is_eq(maxZValue,newOriginalPoint[2],MINTOL))
    
42.         {
    
43.                 UF_VEC3_affine_comb(basePoint, -longDistance, projectOrignialUnitDir, newOriginalPoint);
    
44.         }
    
45. 
    ! c* G/ G+ d4 {2 {( `7 t
46. 
    - `- M) B5 n  P& b
47.         Echo("cosAngle: %f ,longDistance:%.3f", cosAngle, longDistance);
    
48. }

复制代码

1 M) j, r. [5 l& z: Z+ E
: f& P7 R+ `0 w' U% H' Y; f2 `5 ?