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

admin

4 ^8 P* o' o! r( z/ i

#include <math.h>
//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
: e: i' a( X# B  U! Y2 y! L/ j{
        int i,j;
8 x8 k  o" r2 `9 Y- U: N
* v$ z$ ?( @  f9 \0 b% x/ g% B        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
}
/ a, ^7 h2 E- z7 _  y) M, f//矩阵初始化
& b# [6 ~; O/ I( L5 [4 O1 ^( |void Project_Matrix_Identity(double mtx[4][4])
- ^% m- P8 W' u! L. {{
        int i,j;
       
$ n" o: x2 T" Z% Z' x7 E        for(i=0;i<4;i++)
/ D3 H3 q2 R0 L% ~  D* P! x' c                for(j=0;j<4;j++)
                        if(i==j)
, l) E: O- f" o0 `9 D                                mtx[i][j]=1.0;
' z1 }+ x  x) ]: M6 [                        else
) e# P# p, r4 i+ M4 Q* `! r4 y3 K* }' k                                mtx[i][j]=0.0;
}
//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
/ M7 F) M: r  c. L8 |) `{

        int i,j,k;
        double left[4][4],right[4][4];
& y6 T% S# W% A
        Project_Matrix_Copy(left_mtx,left);
$ t. _8 l1 c6 {$ k& W4 j5 z        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                {
                        get_mtx[i][j]=0.0;
/ [& v$ f' H: |2 E6 `& p1 g$ g0 F                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
$ K0 }4 {8 r# Q) `. e                }
}
. N; i9 t& @6 W4 L( B8 [, x//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
, b' b: _5 u' C5 i3 y# Q{
/ v: N" h" \" m  C9 p        int i,j;
; o% J5 K! V9 ?1 v* a2 C' U        for(i=0;i<4;i++)
        {
, @% V9 }# q! Q+ r7 ^3 }: `' u                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
8 O+ y" j3 [' x$ w                }
        }
}
& G& i! H* E1 `//从11元组获取变换矩阵
, |4 T4 z7 }+ Y& Yvoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{

9 l5 @  n! ~- N- w        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
8 N4 t. S* w/ g) o5 d% e/ l; d! B        int i,j;
) r# k& m& j7 j# I4 H& u        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
% ]6 `! c6 O7 j                if(i==j)
                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
% `  j/ E. F2 G4 `. E        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
( c, ]' \: D- @/ _8 M, d, |. H% z}
//向量缩放
. x6 y1 t9 E. {  t+ b  A! K  s" Nvoid Project_Vector_Scale(double a[3],double scale,double b[3])
3 \' T2 T. n; M0 Y- [{
8 l9 \* H# _# Q: T. n        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
$ H" p: F5 {; {3 p        b[2]=a[2]*scale;
' ^# f% e& v! {+ K- v3 l0 H}