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

admin

: V& ]. j' P! `
- w& y- {- T! w& ]$ b
#include <math.h>
* M1 W6 A5 Z$ h! r; g9 B//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
        int i,j;

        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
' J* I5 U( L. ?' o, \: q                        to_mtx[i][j]=from_mtx[i][j];
}
//矩阵初始化
: E' A1 E6 w  g# F2 S7 e" P0 C/ pvoid Project_Matrix_Identity(double mtx[4][4])
- b" n# y) T( j( h$ _, @{
0 j& f' J& r, `( S2 e+ \1 ]        int i,j;
. V: C, D; `* u       
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
7 M$ d" W9 z8 v: e6 [0 _' |; E                        if(i==j)
                                mtx[i][j]=1.0;
                        else
1 e3 P! ^1 c5 e# }; K) X0 e% O                                mtx[i][j]=0.0;
! J4 Z+ `& |. y* _! _. L( t3 p}
" y4 ?! A2 t0 c: u# \//矩阵相乘
. a6 q8 L1 `+ N& s. U" y9 ?# pvoid Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
& [& c/ _6 L* o% y0 G) c5 {; j6 _9 z{

        int i,j,k;
' }( y& V  a+ L7 |, Y/ [        double left[4][4],right[4][4];
, l  |* ~. k9 h' M: j
        Project_Matrix_Copy(left_mtx,left);
+ F2 N) Z1 o9 P/ N5 x0 J4 k4 f7 v        Project_Matrix_Copy(right_mtx,right);
4 h$ C) k: Q$ [: H" n# o( P        for(i=0;i<4;i++)
7 @, r) k$ {6 b+ k; J                for(j=0;j<4;j++)
                {
7 k1 _7 e; k% s, d                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
4 b0 J) r; k9 J                }
}
5 U, z+ S; U3 u" q# s5 U* Z//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
        int i,j;
# C6 u( i! W) L4 S" u+ `# N        for(i=0;i<4;i++)
" X0 A" H; D  M" ]        {
                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
                }
9 {4 x1 u3 h; ]4 [        }
}
//从11元组获取变换矩阵
( d- R; Y! s) S2 Q4 m/ Lvoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{
3 H" y/ J0 r! c. P4 Z
5 l, J2 q& ]. c' t        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
0 f1 h, _0 C- @        int i,j;
5 G1 H8 A' a$ L7 _+ {3 N        for(i=0;i<4;i++)
" a6 ]9 w8 H/ @) c, Z        for(j=0;j<4;j++)
                if(i==j)
                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
* k1 d( J/ ]. N  U3 V0 K        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
. {! n4 b/ L: k. E/ `. r}
6 f  a3 I: Q* D! N8 j1 s. Q: t//向量缩放
" n( i$ v& R: C1 A3 r& P3 [void Project_Vector_Scale(double a[3],double scale,double b[3])
' \7 p( ~- |9 r. p  u{
        b[0]=a[0]*scale;
$ p5 R1 u/ T' @3 \0 g9 V        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
- K5 C% T( P- I6 c}
$ Y% d" s0 ^8 q/ _9 {