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

admin

- J+ r5 l2 [4 b7 E$ M3 Q

  \* y8 ^% |& s% H/ H- }6 W#include <math.h>
4 d6 N6 V* E& `/ s6 Y//矩阵复制
% C, x- Z8 h; S7 Rvoid 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++)
                        to_mtx[i][j]=from_mtx[i][j];
: J8 M& g' [9 T1 P}
4 Z" [" J9 ?' M5 e* H) t# x, h: q//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
. l; B1 u( _7 B5 \" z{
        int i,j;
5 @7 q" c! M+ r3 f9 B! _4 S       
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        if(i==j)
                                mtx[i][j]=1.0;
                        else
                                mtx[i][j]=0.0;
}
//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
* f3 u; n5 M0 C{
/ v. [1 Q  [: Q8 X+ c8 o3 l
        int i,j,k;
        double left[4][4],right[4][4];
1 D+ @( I/ L6 B3 w
/ ]6 J( |7 M/ e# k6 S7 c        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
. ~/ y! g2 m2 u9 F1 f        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                {
                        get_mtx[i][j]=0.0;
! s$ g! P$ b2 `                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
}
//转置矩阵
% S: G+ R( R* z& b( _# _0 p" Qvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
, p4 _" w! F4 y        int i,j;
# B) F: Y/ l* B- W; Q  t        for(i=0;i<4;i++)
$ ]  L' C9 y2 f; [( y        {
                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
1 @8 O" a) P( X2 W6 X) P* N* G; M}
! u% y  d7 s. @$ o) x& ]//从11元组获取变换矩阵
0 [( J0 _! H$ J  F/ Y5 [1 }void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
7 R: j& u1 z+ E! i7 x, i: o2 ?{
5 ]1 e5 s) w! N( l
        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
4 {( d! H/ D3 ?        for(i=0;i<4;i++)
6 m( V# y+ C% D' `1 x- c0 t        for(j=0;j<4;j++)
                if(i==j)
: a( G& s( {/ o- \                        pos[i][j]=1.0;
% G( ]" @* p  Y2 e- Y' W                else
, o$ c2 d) W5 w( q- c& c) k                        pos[i][j]=0.0;
: \" r2 S' A, a        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
, D! j0 F1 D0 M- z- C3 s}
//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
{
        b[0]=a[0]*scale;
! ]0 o) C7 B( S        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
/ K) b6 _( J" P* K  {}