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

admin

+ ]1 }6 ?* K' S. s& L1 C
#include <math.h>
//矩阵复制
2 S# d, l% }) j8 ?* bvoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
: }! s' w2 Y% {, X6 C        int i,j;

        for(i=0;i<4;i++)
9 {0 `4 R; }, T$ C* S7 `) V2 i                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
! s% K( ]( s* q" m# R& p2 n. u}
//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
0 o( q$ }6 R: p. E{
7 ]) v  I' b8 T% }7 \5 V! u5 d& W        int i,j;
       
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        if(i==j)
                                mtx[i][j]=1.0;
. e5 v: @& P# |, s% I                        else
# _$ d* I* h; |2 s- W                                mtx[i][j]=0.0;
+ f8 n! V% m0 I9 n}
//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{

        int i,j,k;
! p7 g' s* L) h8 s! ?# o- n        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++)
3 G# [* C% x: Z, D+ K- y                for(j=0;j<4;j++)
2 i1 W, r( n) a4 W                {
9 F7 _, A" ]( V" o% e7 S8 Q3 [                        get_mtx[i][j]=0.0;
( _1 U* @  P8 S                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
5 d9 W$ Z, z2 O* B9 j}
% n9 z: x; ~, x) S: ]//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
+ h# `2 ]% h4 r# G$ x0 H/ p        int i,j;
# h" E6 B7 ?- V        for(i=0;i<4;i++)
        {
                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
+ \7 w0 z( O5 V0 g8 M}
//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{

; v& d6 v5 I2 o! @# U+ |2 f        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
' z1 z7 W) i6 e        int i,j;
; e& A8 g9 o) }8 e        for(i=0;i<4;i++)
) E, r3 ]9 P; i9 R$ K1 o        for(j=0;j<4;j++)
) B8 Q% B0 v4 [& m6 K& [6 }                if(i==j)
9 d* V0 J+ p" p7 S3 M; u' i                        pos[i][j]=1.0;
                else
3 D2 w& f2 P+ ~$ j                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
; {+ {' v5 ^3 l$ ]0 u( o0 C4 S$ M        pos[3][2]+=translation[2];
}
% b+ t% u& z5 r; q//向量缩放
; h. @: P3 G+ C* tvoid Project_Vector_Scale(double a[3],double scale,double b[3])
6 x& M- Z; K/ ^% R) h  Q0 M{
        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}

! |+ b/ v: X7 C9 S; b" z