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

admin

% g6 }8 M7 D# k1 q- p% |$ E
#include <math.h>
//矩阵复制
8 Q- W% s( j9 L1 Q, Fvoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
* n% ~6 v9 ~( x" L. t4 y2 `{
0 e1 h1 O8 W" I  h2 y        int i,j;
3 Q) V+ n' L+ ], Z' ~
% y7 M: i& O6 x        for(i=0;i<4;i++)
0 P. T* J. B+ x' {) p  f! @% r                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
}
//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
{
! p, [( J! B+ R) ~  i, [        int i,j;
0 Z! O8 u1 p3 p& m6 Q$ g7 w) j* O# p       
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
* g5 Z. |/ G8 u# l& q% C7 Y$ @) r0 q8 w                        if(i==j)
                                mtx[i][j]=1.0;
                        else
2 l3 B7 q* }. @4 ^" y$ S3 `7 Q                                mtx[i][j]=0.0;
}
//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{

        int i,j,k;
        double left[4][4],right[4][4];
% M9 @0 I6 c* u; v. i  @. \8 U
: z' ?9 Q6 _. S* K        Project_Matrix_Copy(left_mtx,left);
0 Q, T8 r. h: ]' b  A: A% H# c( |        Project_Matrix_Copy(right_mtx,right);
' ]1 H1 i4 L# g: m        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                {
                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
: Q4 Q4 u9 ^% C                                get_mtx[i][j]+=left[i][k]*right[k][j];
- P6 W3 g8 t; U! s8 r                }
2 ?' L, x; X( ?$ d! B! \( o}
+ q8 m  [4 f3 v  u4 _& c) p0 I//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
* a- ?/ x' _5 o7 X2 S- d2 H{
        int i,j;
3 p# E$ ~4 t9 H2 v        for(i=0;i<4;i++)
        {
                for(j=0;j<4;j++)
# F, J, z+ X7 `, b4 B4 I                {
' G( S* X" g* e7 k                        transpose_mtx[i][j]=mtx[j][i];
# q: S) A7 X. P" u5 T& ^4 L* X9 I                }
        }
}
//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{
/ k5 f; a, M: P. B: J0 M4 R( i
' W+ y' I$ Q! c        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
        for(i=0;i<4;i++)
6 u# ^" u1 H, y/ |        for(j=0;j<4;j++)
                if(i==j)
                        pos[i][j]=1.0;
& C$ o6 I. W) [9 }! |1 R                else
+ Y  s( d$ p! |  ]2 d* W9 q. G                        pos[i][j]=0.0;
2 ^9 ]: q& o# O" Z# a        pos[3][0]+=translation[0];
* }% y/ d& G8 z3 [        pos[3][1]+=translation[1];
( T+ V; \) u1 Z* s5 V        pos[3][2]+=translation[2];
6 Y% Q! H; V! D# U+ Z1 U' x}
* q! ?) ]! z3 G; z$ l9 g8 i//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
{
        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
% Y, y6 S* }0 c4 _' d3 g8 ^# p        b[2]=a[2]*scale;
3 r/ \- K) r  A- T}
* Q% z) H' ~" X, p$ o; I% y5 @