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

admin

; B5 }, z4 I7 s7 W( ^

#include <math.h>
//矩阵复制
- ~# y$ g7 }2 ]. i9 ~9 W: ~. Qvoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
# T* e+ Q) s* P{
) P& t% ~! }; j        int i,j;
; X5 X6 P' M* B/ p$ y, w+ g" \6 s
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
}
//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
{
* r' x$ v% w- P" C+ e        int i,j;
$ f- o! S( y, j" z       
        for(i=0;i<4;i++)
' K5 b7 b. I# J                for(j=0;j<4;j++)
                        if(i==j)
& K* K4 @" q! f  _, h                                mtx[i][j]=1.0;
& [) o8 u3 U! i/ w  F$ G+ I                        else
* Z9 U2 h; e* ^; |0 G$ c                                mtx[i][j]=0.0;
; z/ L- G( I  x: a9 ~+ k}
//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{

! g. t7 X* a! z# W) i$ w6 M        int i,j,k;
        double left[4][4],right[4][4];
, C2 W( L+ R& r+ t
        Project_Matrix_Copy(left_mtx,left);
0 F; b$ L; T8 f# m2 _1 j        Project_Matrix_Copy(right_mtx,right);
' m' _9 y+ @! t        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                {
                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
5 {# i3 j" E1 r, e1 R                }
}
/ B1 v# t$ H+ d- Z//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
9 U- j* G& X9 g( _: Y0 G) Z5 n{
        int i,j;
        for(i=0;i<4;i++)
        {
: A! W, r7 q4 m6 p4 i9 U9 R                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
6 w9 M9 X% B, q: l7 a7 W                }
* D. B& o8 _5 g- ^: _& F/ h        }
}
+ v' i* M6 Q5 j//从11元组获取变换矩阵
" c$ p' g. g% ?/ e! xvoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
. Y1 D- x% A+ X{
. c* o, g) m9 D7 i+ ?
7 S" I9 K+ t7 o5 Y: \        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
$ B7 K+ Z/ O0 J, }# @1 O        int i,j;
/ G) D3 V) l. F4 h% o) y        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
                if(i==j)
                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
, ]& b7 i; [% ?$ C7 X9 x        pos[3][2]+=translation[2];
}
7 M  x6 {4 M4 x- {3 @8 c//向量缩放
9 ^) z5 g+ @9 s; g4 P3 \void Project_Vector_Scale(double a[3],double scale,double b[3])
{
, u. i3 u5 n& E- ?; \        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}
) `5 L; l: U( H* ~2 s
. b) Z+ N+ f, A, e6 a1 }