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

admin

#include <math.h>
6 b+ A1 D/ G" v% V. K' Q//矩阵复制
9 L5 ^/ Y% d& W3 ]' ivoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
( o1 B: L& O1 A% H7 J" f        int i,j;

" j6 o, y1 G8 K! D) c% C        for(i=0;i<4;i++)
6 P% S( u* y1 B% S                for(j=0;j<4;j++)
' f1 A6 A- v( ^$ e( R                        to_mtx[i][j]=from_mtx[i][j];
9 C" U0 _6 N  T( z( ?/ s8 @) m}
//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
5 o9 ]7 c  q- ?{
        int i,j;
       
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        if(i==j)
                                mtx[i][j]=1.0;
- R" q& j+ z6 d) z( c                        else
                                mtx[i][j]=0.0;
$ f5 \. i5 T! ]}
6 ^8 Y9 q8 _9 p( p$ v: t" z% ~//矩阵相乘
. O8 d; z( n# r5 v, J! g/ y) f( Lvoid Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
  {0 {% [* ^( }9 A# y, G{

4 E0 O  o8 E( K+ U        int i,j,k;
+ k9 Z& z* Z* x, w' Z' k        double left[4][4],right[4][4];
( t5 b5 o" G' M  P; c
4 p0 D" |. a% U2 j        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
6 L' |, h4 q- j8 }" D; K6 \                for(j=0;j<4;j++)
+ T- [6 B0 T5 a9 P5 s                {
                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
3 m1 ^) ~3 n; I                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
}
; r2 I3 d! m1 V9 |//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
3 D0 D8 ?0 P( g' S{
        int i,j;
        for(i=0;i<4;i++)
$ i  W8 |2 m7 h, ~) g" n6 m  H        {
                for(j=0;j<4;j++)
) v, l! g" K; i2 O                {
! Q8 S' w! l3 U; [5 p+ f; [4 y                        transpose_mtx[i][j]=mtx[j][i];
/ ?% D  m& L% i9 T* M. j& d1 e                }
# ?1 [, v9 |* F# H( ^        }
% c& Q9 L# F+ ~( [3 C7 }}
2 J0 M, W( ^$ |* k+ Z- B//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{
, e. L' N/ A3 l; E6 }
! F8 p) O: }1 M, a3 p8 V        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
: t2 l0 y2 x) _+ Y9 ~        int i,j;
& Q' w3 }; n3 k2 y1 f; a; X        for(i=0;i<4;i++)
" N! `9 ^% w9 l3 ]; `9 F4 K        for(j=0;j<4;j++)
                if(i==j)
                        pos[i][j]=1.0;
& k9 N4 L$ U; Z1 k9 E1 u. }% j$ w                else
. q  Y/ x- |/ t% P, |- R! t                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
3 h# ?$ E9 u2 e+ m  \        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
}
//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
{
: j# |% p4 t8 O; D6 I        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}
+ h7 v$ W3 M% W9 P' T4 [+ t