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

admin

! K9 ]8 V6 C% b0 N& f

#include <math.h>
//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
        int i,j;

+ a! ?, U. Z/ P  v1 y! M2 O        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
}
//矩阵初始化
* R3 W$ g! {% R: K2 c$ S- jvoid Project_Matrix_Identity(double mtx[4][4])
{
9 Z/ d4 T7 R% i! p+ \* ~, J        int i,j;
* E0 ^$ e4 y' B       
        for(i=0;i<4;i++)
0 x4 \& r1 U: r+ }3 N                for(j=0;j<4;j++)
                        if(i==j)
* `+ f1 f* e+ m4 }                                mtx[i][j]=1.0;
: A7 \$ M3 c6 C3 U                        else
                                mtx[i][j]=0.0;
; N' b- j" r2 o! r}
: o" e% W- y6 X( Y+ v, s) B//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
9 T  w/ d8 [3 C2 U& v; a{
+ e% x! _& o% }3 p: J  Q0 r
/ ?% t9 }" W+ o3 s- m* {        int i,j,k;
        double left[4][4],right[4][4];

7 d: m! S- p( C! m3 K* U        Project_Matrix_Copy(left_mtx,left);
+ E% |7 W+ J: i" ^& N1 ]* g" D+ m- O        Project_Matrix_Copy(right_mtx,right);
6 S/ a) ~9 W. T        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                {
$ K: }: J4 e" n2 b                        get_mtx[i][j]=0.0;
& N" a$ p1 @- U/ Q7 Y8 W+ m                        for(k=0;k<4;k++)
' @! M" \5 D3 u; v" W7 H                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
}
9 q, X0 r" W$ p4 [. x# H//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
$ O! r+ R/ S5 X{
9 {& l. h. q/ {        int i,j;
% B3 |& r2 N1 y3 \        for(i=0;i<4;i++)
        {
                for(j=0;j<4;j++)
: N5 [% ]$ M: M; ]/ D4 I                {
                        transpose_mtx[i][j]=mtx[j][i];
                }
- _4 m( T) o% Z; ^' T        }
- t2 H3 d& j" ?% \2 I. ]! ^0 P9 N  B3 Z}
//从11元组获取变换矩阵
3 @. w% m0 Y& G6 B$ N& K: Pvoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
% a; m7 v+ V2 Y" _, j! A$ ~{

5 ?. N# l6 w7 s: Q0 ^        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
        for(i=0;i<4;i++)
" H, e6 s% w3 q( _        for(j=0;j<4;j++)
, D* _/ d: `6 O  |, A( M  b* \  B9 Q                if(i==j)
                        pos[i][j]=1.0;
( ^+ s, Q% F6 L7 H3 n- B                else
                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
! N$ R  a! z0 k, z8 S1 e3 k        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
0 c+ j- `  O) ^5 u, w; k}
//向量缩放
5 Z5 t8 c3 m. z1 j. p) gvoid Project_Vector_Scale(double a[3],double scale,double b[3])
{
7 @# P" \/ i: U, i        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
* ^6 d1 ^/ ]( S- _$ c}