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

admin

, x( x) G$ Y' }5 k$ C: z: B. }7 a

#include <math.h>
% @8 q  x: o& i1 J//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
        int i,j;

9 V7 @: A) B5 y! m        for(i=0;i<4;i++)
2 h' c7 y( F/ ]8 u# Q" q                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
$ C9 f0 {; m% U( x}
//矩阵初始化
  x" H8 o: \1 B/ O! ]+ }" H& Ovoid Project_Matrix_Identity(double mtx[4][4])
{
: X2 J" w( `& V* N9 K# f6 v$ M        int i,j;
       
& W" R/ D. V$ a        for(i=0;i<4;i++)
; r, U* k9 |/ {" z                for(j=0;j<4;j++)
                        if(i==j)
                                mtx[i][j]=1.0;
                        else
                                mtx[i][j]=0.0;
}
//矩阵相乘
' @) i$ H" K$ K2 U! y4 }void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
7 D+ W; h8 @5 o( k{

        int i,j,k;
. _& C. o5 j, u8 o& V        double left[4][4],right[4][4];

7 B" C- J0 Z. P) u1 c+ D  ^        Project_Matrix_Copy(left_mtx,left);
! y0 u# R/ S& @: _        Project_Matrix_Copy(right_mtx,right);
% v6 p" Z6 K& p" X% W' ], f. b        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
) u" i, z. B7 e: n( y: J0 m. G; e                {
                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
' Z" A" n4 w) ]9 m* d, [& I" M% `                }
}
- [) p% p" S( R3 {9 C" N//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
2 q, x1 o% |+ L7 b( }2 A  z2 ?        int i,j;
5 L- s8 I  q9 ?3 \        for(i=0;i<4;i++)
  u: Z& z5 z+ p& I        {
: O" |4 Z: W2 w; i! L2 ?8 b: M                for(j=0;j<4;j++)
# r( e& r4 c- `. ?7 N' \                {
                        transpose_mtx[i][j]=mtx[j][i];
                }
; V4 [: B# O1 {: W8 F1 u        }
}
# l) L, }( a- M1 G3 T//从11元组获取变换矩阵
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++)
  C2 U% I9 N. [# j- j        for(j=0;j<4;j++)
2 s5 q' T4 |  _# F1 B& c                if(i==j)
                        pos[i][j]=1.0;
2 c- e- O6 `$ I1 N* i3 s- m; H2 k                else
3 z: C8 o8 `- h& ?& d                        pos[i][j]=0.0;
3 O6 w, y  j7 z) V+ R' `        pos[3][0]+=translation[0];
/ P" ?) G1 ]0 L2 n# p- T8 }        pos[3][1]+=translation[1];
+ t" g: o7 X( P7 T. N        pos[3][2]+=translation[2];
, m: G2 i1 y! \2 h1 o% H- q}
3 \- F0 ?6 q* v, i; p% S, d9 \//向量缩放
! z+ ^0 B* @6 d  {* d3 `5 yvoid Project_Vector_Scale(double a[3],double scale,double b[3])
{
        b[0]=a[0]*scale;
  m0 `, o- d; s2 t7 k        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}