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

admin

1 F9 l& N( E4 j( |#include <math.h>
+ W; [9 h7 B3 j3 h//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
% N" `/ K3 m; D& z# n9 ]) ]{
* @% W7 _8 W- F- d. N! M, e4 R( I        int i,j;
, l" O* G+ k5 }. q. r7 q0 ~% o7 o
6 p% v2 M' j) d- E- O  L        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
}
4 a; F& d: X, [//矩阵初始化
! t! p0 v' S/ }, A5 q& p3 Rvoid Project_Matrix_Identity(double mtx[4][4])
{
        int i,j;
5 d+ n5 F/ Q/ q       
        for(i=0;i<4;i++)
) b' k5 v% R: J. B* T3 L' E- Q5 `4 N                for(j=0;j<4;j++)
                        if(i==j)
                                mtx[i][j]=1.0;
                        else
                                mtx[i][j]=0.0;
}
//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{
1 w0 B& P% G. ^6 f/ O
, b  H; S9 X0 z  p, T        int i,j,k;
        double left[4][4],right[4][4];
1 y4 q( u: z# m- ]1 C
        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
, ~* M. i+ H* Y" s                for(j=0;j<4;j++)
! J3 e+ X( F# d, Q% a, Z9 t                {
) u( p% l' T4 i+ P2 k* |9 K                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
% T; B  i6 {6 \0 i1 E                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
}
: f" s2 u7 G/ a+ x' Q//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
& ?( y: _# E  j- ]6 i$ P        int i,j;
# I. A' a: z% ?3 |  y: W% a        for(i=0;i<4;i++)
        {
- E8 s, \6 [( i1 ]  d) o; s- X                for(j=0;j<4;j++)
/ I. I$ ~5 {) O                {
                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
}
/ s% q8 U2 m3 }! l; E//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{
* Y  j" o3 w! h9 J4 j  i5 K4 O* r$ t
        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
( e* s8 Z; @4 d7 y  B        int i,j;
        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
                if(i==j)
$ h# _( p/ Y& g$ F1 K4 v& ]; d                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
6 q" c2 N. Y! B' y% ~        pos[3][0]+=translation[0];
8 i* F% V7 l# s, X, X6 E        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
0 y% ?8 f1 p; w. i2 X9 ~' U}
9 f& [$ S+ x- O6 Q) Y//向量缩放
( T5 K$ X+ f4 ]3 {' Z4 R+ _void Project_Vector_Scale(double a[3],double scale,double b[3])
9 Z1 Y$ @+ T$ |2 S{
        b[0]=a[0]*scale;
) I* S* U) [* R" [        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
6 r) w$ g: e2 Q! R}

7 a, ^7 r# m. ^0 `' o% |