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

admin

8 S/ _* j' E" b+ G
% E. b) U2 Y, H. i) R5 F6 n. h9 c#include <math.h>
//矩阵复制
: L- g2 Z+ K; `void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
* E) ?0 o, Z% ]        int i,j;

        for(i=0;i<4;i++)
8 k# W* `  U, {' h" W) X4 o                for(j=0;j<4;j++)
8 d9 }/ C. _* `0 P                        to_mtx[i][j]=from_mtx[i][j];
/ ]1 J/ S% g6 B- h) O; N}
. J5 h7 j) Y+ b8 d# g( @//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
, n7 W+ J2 a" o{
        int i,j;
3 b" U* M) \& E- X       
        for(i=0;i<4;i++)
  [3 d+ q4 S. H7 `; n7 b! u                for(j=0;j<4;j++)
                        if(i==j)
                                mtx[i][j]=1.0;
                        else
                                mtx[i][j]=0.0;
. f% A3 f" W+ W) B% _$ Q}
' Q: l2 i  M5 i2 C; _- j8 f//矩阵相乘
5 ?+ {. G# `# X8 r1 \5 V" Nvoid Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{

9 w# w4 I3 @/ p3 @5 b1 `        int i,j,k;
        double left[4][4],right[4][4];
3 J- s3 S9 [" d
        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                {
: n8 E% i6 X$ L" @2 \                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
2 S& _$ S* v; e! }( ?                                get_mtx[i][j]+=left[i][k]*right[k][j];
! ?7 ~0 c) O, Z: o- C; i                }
}
//转置矩阵
4 B# z- o* f5 O: @8 bvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
4 v. y$ O/ O! I- x" w( {{
        int i,j;
        for(i=0;i<4;i++)
        {
' \) [0 F0 b& ]3 U( i: F# W                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
. l$ w' ?7 U+ m9 w2 P, i& r$ ?4 q                }
0 z$ }* v6 h$ U7 N7 R, V- t        }
}
//从11元组获取变换矩阵
( }5 ~4 r5 \2 ?4 v- m' [0 `3 Wvoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
/ X3 K$ c- D* F, r) F$ |, @{
/ T( w$ x" R  f
+ a; x; E7 {- [' `, y5 e0 }! D& ]        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
: ?0 n: u- ~3 l2 m) |/ x6 P        int i,j;
" R4 {2 M+ E" y5 j! I        for(i=0;i<4;i++)
) B; z+ @1 o, J9 y        for(j=0;j<4;j++)
. B0 x6 I" k% J# _8 ^                if(i==j)
                        pos[i][j]=1.0;
! h7 J1 a/ ?5 t# B9 V' E0 [                else
/ @/ `6 n0 C; @" n% |                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
" ^  p+ b9 w) P5 }) l$ S        pos[3][1]+=translation[1];
! T7 T# W- {0 R8 ^+ P        pos[3][2]+=translation[2];
0 X# }& S" h' A0 j1 y4 H4 Z}
$ w, f3 W9 G: K; n9 E" S# G//向量缩放
4 }: n0 C# m, }void Project_Vector_Scale(double a[3],double scale,double b[3])
4 t, R: b5 f1 `: y1 I{
        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
  p2 D9 x% f2 w3 W$ L/ Y4 ~9 |  u        b[2]=a[2]*scale;
7 q' ~  Q) U" O}