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

admin

  I4 H7 B) }8 Q

' P* I5 u) U  U. C1 D+ n#include <math.h>
, Q. W, J/ A2 P1 P/ M; _9 X8 x//矩阵复制
" a6 x4 `+ X; D* B6 gvoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
  H4 ^$ i$ L6 W$ H8 q  q{
9 c7 R; ?5 ]2 H5 ]7 P+ m        int i,j;
$ T/ M* H3 E6 L0 z
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
! ~% C3 m# }/ c  r6 g5 T5 {}
4 \! m0 r: K, q  ~1 l8 W6 p//矩阵初始化
/ i0 U) a0 g/ X+ Z" U/ x$ Z; a( wvoid Project_Matrix_Identity(double mtx[4][4])
{
        int i,j;
0 K5 H+ m* A+ H) u2 o' y' z       
8 e1 u+ i2 L' U1 [' |        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
. e! ]) `2 s# W4 q                        if(i==j)
                                mtx[i][j]=1.0;
                        else
4 b3 Z( s: p5 l+ M2 e                                mtx[i][j]=0.0;
}
; O* m2 i, y, i//矩阵相乘
! [2 p7 P3 i# m% tvoid Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
  l3 S5 d; V3 W7 C2 \{

3 G) W% L- }2 s; z  F        int i,j,k;
        double left[4][4],right[4][4];

+ \: q5 Q$ ?3 F        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
- I0 G: N0 m- U1 T: {. r; ?                {
! f0 i; L% n4 y. \+ S9 j                        get_mtx[i][j]=0.0;
5 x1 o% N# T; y' R# O9 V                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
. c( k: g+ @2 E+ p- Q}
//转置矩阵
4 k3 i+ u4 G2 t, uvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
" ~' r$ u; H  |$ E! l        int i,j;
2 l/ @3 c9 J/ L5 `2 |        for(i=0;i<4;i++)
        {
                for(j=0;j<4;j++)
                {
. `' y3 L  U  S7 }! z7 T                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
}
//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{

; F) s1 ^; r% [- k# x( q6 w        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
6 U5 }' M; E9 s/ k' @% x        int i,j;
. {8 O5 U) W8 t        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
                if(i==j)
  h& h% c6 J& D# ~+ x                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
* S2 W0 j4 m  u4 S0 E6 H        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
}
& r  t- d- G: p9 Y//向量缩放
- f  X; `- T/ m# g7 ?2 x& yvoid Project_Vector_Scale(double a[3],double scale,double b[3])
8 y* e& c5 Z" J/ U{
        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}

( T5 q% c% d8 C0 z