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

admin

! X& V) R2 }9 A% \4 E% B
) l4 V6 t8 |- f6 I
#include <math.h>
//矩阵复制
4 Y% G9 j; Q: j0 }7 Evoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
        int i,j;
% Y6 e/ u( ?' k+ q' ~
$ r9 w) }& \5 Q  r% J; ]        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
( m  v9 V0 v5 A0 h2 r# D                        to_mtx[i][j]=from_mtx[i][j];
$ p* }6 b1 W. Z! S. ?% Q4 w/ x}
) g; G# W( r( Y//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
( E0 R5 [: e% w6 C3 W0 `. {- N' U{
        int i,j;
  {% h) ]- n; `! d- ]' X' I       
        for(i=0;i<4;i++)
  N! w9 Q( ]8 e5 O& m1 p+ @                for(j=0;j<4;j++)
                        if(i==j)
/ I. j1 E, o6 Z9 @& E# I6 d                                mtx[i][j]=1.0;
                        else
% p' s8 P( h$ j6 ?                                mtx[i][j]=0.0;
}
  p  U2 n. y( Q% L//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
! ^3 V& x1 A9 _4 x1 |# h+ B{

% \. ^$ @  v1 \' B" s- q        int i,j,k;
        double left[4][4],right[4][4];
( U6 m% N, t8 t! R
" \4 n. ]$ i* {: C        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
. z5 F9 ], V5 r& Y( p        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
4 \% V; B$ W. ?                {
" J  }6 ]3 D4 J' K7 |% X                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
+ T7 T- z; D2 y" k% k" h7 a' M* {                                get_mtx[i][j]+=left[i][k]*right[k][j];
# n5 i' C. d7 c8 k: c                }
}
9 @3 U  U- G7 q//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
        int i,j;
        for(i=0;i<4;i++)
        {
                for(j=0;j<4;j++)
! A" q, ^3 C! i+ H; V                {
                        transpose_mtx[i][j]=mtx[j][i];
& f; J: L' q8 K                }
/ ?/ u2 b) u6 n; n7 ^        }
3 W' n& p/ l8 T# b) e2 D1 b* W}
//从11元组获取变换矩阵
8 w% L6 b4 }, R2 Y7 avoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
1 k, G+ F4 \" \& s' p1 V" l& R5 ~{
6 s$ Y0 v4 K2 ~* n" Y
        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
, n+ W7 S' x) ], S        int i,j;
        for(i=0;i<4;i++)
+ h  R* f& t1 I( y% t, k        for(j=0;j<4;j++)
                if(i==j)
1 o. ~- _) K! Y1 `' v) t  w  y                        pos[i][j]=1.0;
  c$ Y: O+ r4 \. l( D( x4 i/ [+ F# t                else
                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
}
9 d8 Q! I/ Y* r1 j: Y$ R//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
{
        b[0]=a[0]*scale;
! v. ]- F' k4 W8 S0 B. }6 @        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}
7 f3 T1 [; X6 P" {* ?1 a