UG NX二次开发源码分享：矩阵操作的基础算法代码

admin

# q& f+ E: y' h

#include <math.h>
//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
; a* n# e4 h, u1 f, [, f' u% H& V{
        int i,j;

        for(i=0;i<4;i++)
, b& V. o8 v$ n1 z                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
8 n+ U+ E7 h9 V4 ^9 y}
  D/ U) U0 [/ J% w4 k' `: u4 f//矩阵初始化
6 V; G. W9 w) l( H9 U' {void Project_Matrix_Identity(double mtx[4][4])
  |) g0 T: N3 O9 j- {{
        int i,j;
       
6 B* J1 @, v0 J        for(i=0;i<4;i++)
! K6 f) f. h# }+ y1 G1 K- q# o                for(j=0;j<4;j++)
% N+ A/ @7 _; T* y4 n6 d7 Y                        if(i==j)
9 I: o9 c$ [% m                                mtx[i][j]=1.0;
                        else
                                mtx[i][j]=0.0;
}
5 J- _/ J" H0 _, {: m- ~# o//矩阵相乘
! z$ b. |& x+ F$ Y! zvoid Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{

        int i,j,k;
+ M- U2 K8 ~$ y1 V        double left[4][4],right[4][4];

        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
) c2 U3 ?  @$ r* x# [5 s                {
                        get_mtx[i][j]=0.0;
/ P* N3 p) p+ V6 y' o6 K8 O( G                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
' E8 ^- `  L# E4 ~$ p4 T                }
}
//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
( G/ r, ?; f- `2 R8 n$ h+ G9 N! j. j$ S{
7 {( b* T) ]- g7 O* H1 e        int i,j;
, s, q) t/ C& C- ^4 S! `' X        for(i=0;i<4;i++)
0 }& y) N# f5 _8 n# l5 A& t8 a& n5 }        {
                for(j=0;j<4;j++)
5 z1 y( a! D& H1 X" e3 w1 {                {
                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
. q/ ]  {- D, r; T& }}
/ m4 h8 [" ]$ D//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
( @9 A) r6 n5 E- r{
: |# C3 F8 _5 h9 e( Y
) z: u$ c  i% [3 F        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
8 j# W! \5 e3 l# G4 Q$ j        int i,j;
        for(i=0;i<4;i++)
! J2 B! W5 O, m2 m: ]0 q        for(j=0;j<4;j++)
( n& k. K; `% l4 x                if(i==j)
7 t! p/ N) E3 D6 y2 K' _/ v                        pos[i][j]=1.0;
1 v# Q  ?. S1 F$ c! M" X' v8 C, z                else
. q& p8 I1 Y8 @- L                        pos[i][j]=0.0;
  ]; I8 b1 e# x6 v3 I* R5 d        pos[3][0]+=translation[0];
: T2 _. }, i0 d5 {. X/ E8 @5 I) `        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
}
//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
. n, ]. S- ?% ?7 h{
        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
( d4 j/ W# h$ H& d        b[2]=a[2]*scale;
. Z' e$ x% {! E8 i0 [}
  w9 n5 V3 ^0 ]% {9 N3 M+ c