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

admin

$ }, i3 g4 h; [% A( M. h1 q

#include <math.h>
//矩阵复制
* h$ U/ T& t: j# f$ Qvoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
6 @; J; v4 H0 k+ j        int i,j;

9 _' L+ ~% B( h0 c" T' P5 C4 k        for(i=0;i<4;i++)
2 q. r1 b& a0 ^$ m- X0 Y$ O6 P7 e                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
5 ^0 V& {; u7 r8 D( _5 i# }8 D}
//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
{
1 w( _; A) r# c. n$ @        int i,j;
       
        for(i=0;i<4;i++)
" \4 f2 P6 q! u9 k; F- }                for(j=0;j<4;j++)
1 T6 l+ x% w$ |6 _- _                        if(i==j)
4 t" E- T) A4 z) ?/ _& `                                mtx[i][j]=1.0;
                        else
                                mtx[i][j]=0.0;
6 Q) V1 W/ d7 r! o6 J4 Y% F}
//矩阵相乘
# g- c$ s" u& j$ U0 E5 o8 q* T/ Uvoid Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{

        int i,j,k;
: c8 L6 \. c6 i3 L7 w( W/ x        double left[4][4],right[4][4];
; @( H9 X. L4 g: k- }" y
% E  K6 X: t) n: \! N* `& J- ]$ T        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                {
                        get_mtx[i][j]=0.0;
  G+ A7 W. B. Y6 i                        for(k=0;k<4;k++)
4 b  B5 Z6 ^( r                                get_mtx[i][j]+=left[i][k]*right[k][j];
! C( I1 J0 [6 U, l; o  c                }
}
' C0 t! t, M5 L. r) q//转置矩阵
, e: |# k4 k2 L; z1 w  r  Kvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
        int i,j;
, ?" q9 |; _9 V0 j5 F% }" y# O5 l5 d        for(i=0;i<4;i++)
        {
3 u8 Y) Q9 b0 ]7 N7 Q7 j9 D/ p6 Z: A                for(j=0;j<4;j++)
! Y' X8 M$ d, X                {
1 N* n1 H( i* m% n7 t                        transpose_mtx[i][j]=mtx[j][i];
1 f$ x  J5 _/ {2 Y+ @                }
- M" n. \4 V; }+ n2 k6 x2 m  C8 }        }
" r2 g6 D) T1 }}
//从11元组获取变换矩阵
0 g% D9 e5 m$ a4 M9 O7 r" ~3 evoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
8 ?8 I7 H6 r' a# k- p0 |& z{
" `$ |4 a( {% m3 s/ _% A; B1 D
  `% F# L/ c- V% D2 L4 ^3 U/ b        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
        for(i=0;i<4;i++)
. b0 p" o6 K2 b) ?        for(j=0;j<4;j++)
# L. X4 O! v9 z  r" t                if(i==j)
                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
3 C  \8 I' a1 I+ U: [        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
}
//向量缩放
5 X( d0 Y' [. }6 s. A) d- Lvoid Project_Vector_Scale(double a[3],double scale,double b[3])
& H2 c! ~. e2 a. R4 z0 W! i{
0 Z; _# d) R+ l' p- Y        b[0]=a[0]*scale;
& V3 s8 {1 P; V# [1 t* C        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
8 _6 `$ S6 H' B}