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

admin

8 Q, [$ l% g) s9 E' q2 o2 l#include <math.h>
//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
        int i,j;

" t3 I# s: C- W; l: J* Y  w! m6 C        for(i=0;i<4;i++)
& M- ?! p: W0 Y) [6 c                for(j=0;j<4;j++)
1 {( }) d+ _" L* r$ s4 u                        to_mtx[i][j]=from_mtx[i][j];
' R" A% g1 q  F0 s6 Q}
( ]- q$ `/ E2 y, {  g//矩阵初始化
# D- C8 {) l$ l+ ?+ c5 fvoid Project_Matrix_Identity(double mtx[4][4])
{
( g$ D( h) t$ X! [        int i,j;
2 Y# R* g5 E: K0 `+ d9 B       
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        if(i==j)
                                mtx[i][j]=1.0;
7 V" p# ^  H5 x0 n3 f                        else
                                mtx[i][j]=0.0;
}
- I" k, T5 d* \. E  g//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
2 y; D4 k. z* K9 _4 \9 m" q{
$ `6 N. g6 F% X0 v" V
' V0 \  D) B/ D8 d/ R; d: o        int i,j,k;
# z7 P* `6 c; L8 x1 i        double left[4][4],right[4][4];

        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
1 Y$ l! B1 l+ y; a6 P3 j, U        for(i=0;i<4;i++)
8 K. W- U' D) @                for(j=0;j<4;j++)
                {
  ^! g4 T8 j/ k; P. n; s6 N$ ^                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
" ^3 H% f5 |6 f* J" s3 T) w                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
2 k' I, G/ M: }}
5 t3 ?' X$ n2 j: d6 e- w//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
% e2 z+ K, |3 s% l( ]        int i,j;
  J0 Y! W& ~* O5 l! L9 D        for(i=0;i<4;i++)
        {
                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
6 ^0 z- v2 E1 k" P9 E1 W! Y7 q}
//从11元组获取变换矩阵
$ j5 D" W8 W  }' rvoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{

) @9 J. `6 {/ y7 V0 f6 p0 @        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
3 _/ [3 ]# r- R, J        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
                if(i==j)
                        pos[i][j]=1.0;
                else
( Z  c# o/ D" r1 l                        pos[i][j]=0.0;
- I+ q$ K" N4 g1 m$ w# [! |: H        pos[3][0]+=translation[0];
( D7 ~- |0 s. A$ W/ m0 ^7 o        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
/ `9 u4 S% }) Q7 Y7 ?}
" U1 D, r; b: Y8 ]: c//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
+ q( P2 h5 S3 j{
        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}
$ L0 z/ V. h- c9 _