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

admin

' r9 |3 R5 s/ K5 {$ _  n. ?. v
; A2 U1 H1 r  F) Z2 _' z3 `
/ d! q) n/ P- G3 {#include <math.h>
- J6 f. u; V( F# Q2 T( c7 Y//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
2 @' d( c$ n) ^4 `! _        int i,j;

        for(i=0;i<4;i++)
- n* b1 r9 o% f                for(j=0;j<4;j++)
" D& W8 _. L4 u* b' u                        to_mtx[i][j]=from_mtx[i][j];
}
//矩阵初始化
  e' t. `, x( Y, Y# Tvoid Project_Matrix_Identity(double mtx[4][4])
7 O7 q' Y9 ]* H+ q+ J7 e% a+ I{
% I( C' B6 m. \5 u# B6 G/ m2 r        int i,j;
       
. _- }/ ^$ G+ [/ z        for(i=0;i<4;i++)
# e' H( p2 t7 R, H. O                for(j=0;j<4;j++)
: K! w1 ~$ e  m) r                        if(i==j)
9 a& U) E- f, E) B$ E                                mtx[i][j]=1.0;
6 l# \) s+ ^0 K- L1 I5 D% |                        else
                                mtx[i][j]=0.0;
, K8 a/ Y. ?# P& E) ~$ b}
//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{
6 y% I  ?' `& l& E
        int i,j,k;
        double left[4][4],right[4][4];
8 F& Y0 C9 c0 F# ~
        Project_Matrix_Copy(left_mtx,left);
' I$ \% J" ~" G/ Y        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                {
0 E8 R3 S: g6 [: z" s" @                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
& G3 B' F: _$ R# h/ k; a0 e}
4 p4 K0 z9 \  N/ A% X3 Y/ ~/ x//转置矩阵
4 `+ R6 D9 X. N" C% U# Z+ [void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
, f! r& {8 B9 v) K- X& k; e{
7 x9 t& x* l- o  t0 q& H        int i,j;
        for(i=0;i<4;i++)
9 C! l9 b$ T9 ^1 v        {
) A" t8 W9 U  ~$ a2 l                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
                }
1 i/ a7 T& r# c. j& M8 e$ s' e        }
}
+ n; b; Q0 [; [+ c1 V//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
# A. a; [+ ^  k5 Y* L{

        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
# y' w; @' B0 j5 }% U9 l6 E        int i,j;
! X( j9 k/ Y, x; B        for(i=0;i<4;i++)
6 g7 C9 l6 @! w        for(j=0;j<4;j++)
                if(i==j)
/ [/ `5 I3 T5 s. q3 K6 f8 F                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
! v* j2 a2 N' p- r( q2 o6 d        pos[3][0]+=translation[0];
- }1 G+ _$ A4 o4 Z% [: t" [. C        pos[3][1]+=translation[1];
) h+ Y0 @; x4 w* v. ?        pos[3][2]+=translation[2];
% }5 v) ]9 |1 a* j0 |* v# h$ x}
# i; a* `2 a0 Q" E: Q& {4 ^. G//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
  M  R' o% q1 `2 X. y/ Z7 c/ ~{
        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
' w. I  c" x2 `/ ]' E. N7 {  k        b[2]=a[2]*scale;
}
9 v' ^: o5 N* k8 t  s( u