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

admin

) C- g8 \7 k8 l$ v4 _; q; e
% Z2 K  ?, i9 x4 e0 `#include <math.h>
' v4 e6 v+ I0 J& s//矩阵复制
8 _2 V3 Y4 Z; {" pvoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
& ?9 m% j$ b, @. f5 G{
# a* a- D/ f& d3 U        int i,j;
9 c; {9 G1 t+ z/ u. a; e5 ~/ e. S
3 K, f* M1 c$ [# C" w0 `- K        for(i=0;i<4;i++)
2 I" }0 W9 C8 p* E: W  S                for(j=0;j<4;j++)
7 e' L2 x' }5 \) D1 t                        to_mtx[i][j]=from_mtx[i][j];
}
//矩阵初始化
) S9 W* \. H5 evoid Project_Matrix_Identity(double mtx[4][4])
+ D" Z0 K3 \1 m9 ?6 E8 t{
9 C& |( @4 I# M% k5 W9 Y1 v        int i,j;
% @, y  v8 g1 i) S1 X& i       
# ?7 E0 W7 \& p# L6 C3 h# ^        for(i=0;i<4;i++)
5 W: U, L" L& B+ p) T/ _0 w# {$ l6 M                for(j=0;j<4;j++)
4 I" ~2 Q8 D7 O+ Q7 o6 T  w+ q$ ^                        if(i==j)
                                mtx[i][j]=1.0;
                        else
                                mtx[i][j]=0.0;
; k8 H6 Y( I  p6 T; w$ ]}
' s8 O" w# F- _! L& E% g//矩阵相乘
6 f8 A9 z- G3 q' ~3 ^# svoid Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
& f2 O) O+ X- G5 V; Y2 u3 w{

        int i,j,k;
        double left[4][4],right[4][4];
& Z  i5 d  z7 _& D7 c
8 \0 T1 M7 V$ R: g! S+ ~  e2 u! g        Project_Matrix_Copy(left_mtx,left);
" y! n4 p* y! \3 [        Project_Matrix_Copy(right_mtx,right);
, l+ m% y1 @& c$ `1 B9 Z        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
9 M' @6 M. ]: \3 i$ r                {
& y# s( g$ U4 g3 X                        get_mtx[i][j]=0.0;
9 J+ e. z# S- o. I3 Z& f: S" x                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
4 k6 t: l) v; w+ Y' F                }
}
//转置矩阵
4 ~% `/ U1 B# `1 w* j$ x# {6 wvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
        int i,j;
- }+ ~: X, q- `) u3 B        for(i=0;i<4;i++)
2 m! ^2 ?5 @% M) E1 E# D        {
                for(j=0;j<4;j++)
                {
6 n1 v9 M5 O6 D' ?                        transpose_mtx[i][j]=mtx[j][i];
                }
2 n) ~, [' I  @% d$ U9 B9 O" q3 E        }
}
! ~+ a- o( z# v% \( q/ o7 q$ w//从11元组获取变换矩阵
1 z' R( y  o5 j; W/ {void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{

        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
        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;
" K3 R& `# H4 D; w% H4 O        pos[3][0]+=translation[0];
% {( o3 Y, R" B& s        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
- U+ X! ^" `  D% Y% G) n}
//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
{
        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
0 j  v; }* O5 L$ j; u6 R0 R: n}