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

admin

) h; {  y2 M; l: |4 [& c' C
6 p5 L4 \, D% z2 e  o
#include <math.h>
5 l0 U6 L0 D( K8 ~  B/ S# w4 R* I//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
; R; z$ G, w% \& h{
1 o, l  @6 F  [% C7 ?        int i,j;
2 x& `* Y6 x2 [4 E5 ~* x- r
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
: _4 ?2 P0 L6 _; |/ s! b}
//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
{
2 J# ?8 b0 x  C* e) \- J! Z        int i,j;
. R" g3 t8 F# ~" F7 t3 }  K       
4 ?0 z5 g/ |7 a5 C& Y2 w        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        if(i==j)
1 }; w9 p! R' i4 H0 L9 o2 n* I4 H                                mtx[i][j]=1.0;
  A% T  x% Q( S) h; i0 y! P6 j$ C                        else
! p( A) |: T8 B7 G0 _                                mtx[i][j]=0.0;
6 e7 G7 ~; Y1 _: }4 n) u, }/ C9 v}
. }9 M+ ?" d& m//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
/ y2 m  x, M4 I1 @8 h{
, }6 L  N) @+ ~% U( K
0 j0 C# t- w. Y, z% D        int i,j,k;
: P4 F" w4 q' p0 w1 ]+ o        double left[4][4],right[4][4];
, I5 a/ B% ^2 Z5 |' z
( ~* V6 l( o. ]* p4 j% i        Project_Matrix_Copy(left_mtx,left);
; T! X- V0 {1 R' E6 _, H' p        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
% }: Z) |4 R" ^# ]1 I                {
                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
: W8 B" r+ l& B  u* I3 V* ~                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
& Y1 q9 r+ _4 n8 i, h}
. b& ]! [( |3 e; u4 D: I2 e//转置矩阵
+ C: ^; Q3 Y6 c; o- [void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
' X- D& L5 l+ ]5 O5 U2 b, t2 ]        int i,j;
& f+ {3 H& y9 l, w. m) M8 E        for(i=0;i<4;i++)
        {
                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
4 V3 Z' o% `. G( ^3 z                }
: Q) u- u% l; Y& f1 Z! a# J- k        }
6 V$ P" y. v3 F% T+ F* h}
//从11元组获取变换矩阵
$ J4 m. K# L: C; M, S' bvoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
$ K4 f% \8 Y0 G1 @{
' a, n8 @+ _+ D' K: g' w
: j+ B8 w8 y  T- _5 E# I2 c, ]4 K        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
4 Z3 N! h" t) U  [2 r4 u                if(i==j)
9 X9 W) ^3 I/ n                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
- s. W( D. c  q5 B7 C! U        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
}
//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
$ c3 R) e/ P9 z( w$ C# \{
        b[0]=a[0]*scale;
8 t. O& A% g- b8 T* i        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}