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

admin

+ K/ u0 y8 f; U+ L9 s# \#include <math.h>
//矩阵复制
# J2 a: i  E% y# x; ^& Y4 _void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
$ z- ~$ t+ J1 x) u- v' M{
        int i,j;
* ~! t: z. X5 x, j0 d0 g
; X( |/ u3 l3 Y) D4 {, m        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
$ [  b; y6 k" B5 G" ]                        to_mtx[i][j]=from_mtx[i][j];
}
//矩阵初始化
. x' x+ c7 Y, {  i, dvoid Project_Matrix_Identity(double mtx[4][4])
{
        int i,j;
( m0 E6 o( j5 m. y% z       
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        if(i==j)
                                mtx[i][j]=1.0;
                        else
' C6 g. f8 ?* h- I' B                                mtx[i][j]=0.0;
+ K8 o7 o' t% |5 E}
: K, Z. U$ h/ S//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{
; J  g& ?/ T, \! Q& P
        int i,j,k;
        double left[4][4],right[4][4];
) B7 ]( Q& n5 A) w+ h- U4 }
. j" Q# o, ]8 a! \. [        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;
, c! s; v9 t2 {- |8 O% H8 a* K  @                        for(k=0;k<4;k++)
+ o* x* ?" x# [2 Q5 j! a                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
}
//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
) f. a! D: X0 E3 n( N$ v        int i,j;
1 T% a9 J5 ^! @+ T/ Q1 M: z8 G3 X        for(i=0;i<4;i++)
& E3 j* P6 ]% f" J2 ]% q6 M. {        {
                for(j=0;j<4;j++)
; x6 j! s  u" W) W- O                {
9 {+ h& s9 k) O2 K. n5 M                        transpose_mtx[i][j]=mtx[j][i];
7 g8 r6 |0 a1 ]# A                }
        }
}
//从11元组获取变换矩阵
$ a4 j0 y0 z9 P2 m' x5 L$ y+ |  wvoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{

' k  P' C# [6 }9 b3 g5 [* [6 m        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
( Z/ C0 `* Y1 ~' k3 _) K        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
9 e( B) _* w) @- Y& {" m                if(i==j)
9 M2 \$ w. L/ C( l                        pos[i][j]=1.0;
                else
( V1 X: d$ X; c, T                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
: E. t1 }; b3 X& T. p6 }        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
$ p6 }1 {* M/ t9 O% p) I* x}
//向量缩放
+ M% V& T2 A% r" f- l' s/ U" dvoid Project_Vector_Scale(double a[3],double scale,double b[3])
{
: _8 m* q2 p. a. i3 w4 _        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
) L# m2 D. e  L! P        b[2]=a[2]*scale;
}

5 C. ]2 u/ x0 b- x5 x4 r3 Y$ R